
Navigation Systems AB 



ARNEX 



Arbr3013 



Goteborg 2008-04-21 



l 



USPTO 

COMMISSIONER FOR PATENTS 
P.O. BOX 1450 
Alexandria, VA 22313-1450 
USA 



US Application no 10/748,207, filing date 12/31/2003, Name of Applicants: Hans 
Robert Holmqvist and Hans Goran Seger, Title of Invention: "Intelligent methods, 
functions and apparatus for load handling and transportation mobile robots". 
Filing of rewritten claims and priority documents. 



End #1: Claims, reformulated, 6 pages IVi space 

End #2: Priority documents, Swedish Patent Application number 0300001-5, 
Dated 2003-01-02, 45 pages including certificate. 



In response to your letter Office Action Summary dated 2008-01-23, we herewith enclose the 
requested rewritten claims and the required priority documents. 

Best regards 

Arnex Navigation Systems AB 



Dear Sirs, 




Arnex Navigation Systems AB 

Box 53052 

400 14 Goteborg 

SE-400 14 GOTEBORG 

Sweden 



Org no 556306-9383 



What we claim as our invention is: 

1. A method for automatic handling of bulk material and other goods where this handling 
comprises loading, unloading and transport executed by a mobile robot such as an 
autonomous vehicle or machinery, for industrial applications within limited work 
areas, outdoor as well as indoor or under ground, characterised by: 

• One or several loading zones are defined for the work area, such loading zones 
being the sole parts of the work area where loading and working of a volume of 
material is allowed for collection of material or other objects, and one or several 
unloading zones being the sole parts of the work area where unloading material 
and other objects is allowed, and one or several obstacle free zones which together 
with the loading and unloading zones are the only parts of the work area where 
autonomous vehicle navigation and autonomously controlled load handling 
implement movements are allowed; 

• A reference surface is defined for the work area as being the supporting surface for 
material volumes and other handling objects, such a reference surface being 
accurately defined in a coordinate system fixed to ground by means of the x-, y- 
and z-coordinates for an ordered set of points on the same reference surface, this 
surface being compared with current terrain surface measurements including the 
surface of material volumes and other handling objects located within loading and 
unloading zones, and where these measurements are used for optimising 
parameters for vehicle navigation and vehicle load handling implement 
movements in loading and unloading tasks as well as for obstacle detection; 

• The position of the mobile robot is obtained, in real time and outdoor as well as 
indoor or under ground, by an apparatus for accurate determination of the position 
in a fixed to ground coordinate system in three dimensions x, y and z and the three 
attitude angles heading, pitch and roll, in all comprising a position determination 
in sex degrees of freedom of a fixed to vehicle coordinate system, where such an 
apparatus can be a laser-optic system in which the position is determined through 
azimuth and elevation measurements, with an on board the vehicle rotating laser- 
optic sensor in a fixed to vehicle coordinate system, towards a number of reflectors 
with known coordinates in the fixed to ground coordinate system; 



• The current shape and location of the terrain surface, outdoor as well as indoor or 
under ground, is determined by estimating, in a fixed to ground coordinate system, 
the position in three dimensions of points on this terrain surface, by means of 
azimuth angle and range measurements in a fixed to vehicle coordinate system by 
means of at least one scanning laser rangefinder, and coordinate transformation of 
such measurements into coordinates in the fixed to ground coordinate system using 
the six degrees of freedom position estimates in the fixed to ground coordinate 
system of the fixed to vehicle coordinate system by means of the abovementioned 
position determination; 

• The storage, processing and updating operations of the terrain surface shape and 
location data are made in an on board vehicle dynamic terrain model, where data 
from this model is used when optimising vehicle paths and load handling 
implement movements throughout loading and unloading tasks by allowing 
calculations of pertinent positions and shape elements of material volumes, other 
handling objects and obstacles, where this model comprises at least three essential 
layers with for each terrain element n within the work area specific elevation 
values: 

❖ Z(l,n) for layer number 1 : emerging model based on data from the vehicle's 
actual pass in its path where this data is obtained from terrain surface 
measurements, 

❖ Z(2,n) for layer number 2: best estimate of the reference surface devoid of 
material volumes, other handling objects and obstacles based on initial 
measurements of terrain surface inside the work area, measurements made by 
either the abovementioned method element for terrain surface shape and 
position estimation or by other means collected information of terrain surface 
shape and position, 

❖ Z(3,n) for layer number 3: a current estimate of the entire terrain surface within 
the work area including material volumes, other handling objects and 
obstacles, 

where this dynamic terrain model is analysed in order to 1 ) optimise the position 
of the attack point or optimising the bucket unloading position, respectively, as 
well as 2) optimising the vehicle's position when attacking for loading or when 
unloading the bucket, respectively, and 3) for estimating a terrain height profile 
along the intended loading path of the bucket giving, for each one of a number of 



successive penetration depths s g (i), i = 0, 1, 2,... of e.g. the forward tip of the 
bucket yielding an average level Zioading(i) in a fixed to ground coordinate system 
for the material volume in a neighbourhood of the forward edge of the bucket; 

• An on board mission computer is employed where this computer is provided with 
mission instructions defining obstacle free zones, loading and unloading zones, 
parameters for static and dynamic transport paths, reconnaissance paths, loading 
and unloading paths including also programs contained in the mission instructions 
for selecting and tying together a sequence of paths and movement processes in 
order to assemble one or several handling cycles, and furthermore provided with 
algorithms for vehicle path optimisation and vehicle and load handling implement 
movements when loading and unloading based on attack point coordinates and 
bucket unloading point, respectively, plus the terrain height profile {Zioading(i), 
sg(i), i = 0, 1, 2,...} from the dynamic terrain model; 

• An on board vehicle control computer is employed for controlling vehicle and load 
handling implement in the current vehicle path and the current vehicle and load 
handling implement movement process based on data from the mission computer, 
where this vehicle control computer has interfaces to the actuators and sensors 
intended for the steering and driving of the vehicle and its load handling 
implements. 

A method according to claim 1 for obstacle detection for the purpose of avoiding the 
vehicle to get into a too close proximity of or colliding with an obstacle, to supervise 
the progress of the vehicle in order to initiate an emergency action should the vehicle 
risk to move outside the areas intended for autonomous navigation and in order to 
evaluate and accept or reject planned vehicle paths and vehicle and load handling 
implement movements, by employing the dynamic terrain model for this purpose and 
characterised by: 

• An additional layer in the dynamic terrain model is used for marking obstacle free 
terrain elements; 

• Classifying an element no n in the dynamic terrain model as an obstacle free or not 
obstacle free terrain element is done by continuously comparing Z(l,n) of the 
emerging model layer of the dynamic terrain model with the current best estimate 
of the terrain surface Z(3,n), whereby the element no n shall be classified as 



obstacle free if [Z(l,n) -Z(3,n)] < H, where H is a given least obstacle height for 
not classifying an element as obstacle free; 

Evaluating and accepting or rejecting planned paths and considering the risk of the 
vehicle moving outside those areas intended for autonomous navigation, for the 
purpose of being able to detect possible planning errors prior to driving an 
intended path, this evaluation is made by testing for each element no n in the 
dynamic terrain model if such an element to any part contains a part of an obstacle 
avoidance zone mapping for any one of the successive positions of the vehicle in 
the planned path, whereby, if such a terrain element does not belong to any 
loading, unloading or obstacle free zone, the planned path will be rejected, where: 

❖ One or more obstacle avoidance zones are defined in a fixed to vehicle 
coordinate system; 

❖ A specific obstacle avoidance action can be assigned to one or more obstacle 
avoidance zones; 

❖ Obstacle avoidance zone projection is a for the moment defined surface in the 
fixed to ground coordinate system, where such a surface is the horizontal 
projection of a fixed to vehicle obstacle avoidance zone for a specific vehicle 
position in its path; 

❖ Obstacle avoidance zone mapping in the fixed to ground coordinate system is 
the union set of a sequence of all obstacle avoidance zone projections, where 
each such projection corresponds to a specific position of a sequence of 
positions of the vehicle in its path; 

Obstacle avoidance action is initiated based on the presence of a non obstacle free 
element no n in the dynamic terrain model inside any obstacle avoidance zone 
projection for the present position of the vehicle, in which case the obstacle 
avoidance actions carried out are assigned to the corresponding obstacle avoidance 
zone; 

Obstacle avoidance action is also initiated on the presence of a non obstacle free 
element no n of the dynamic terrain model inside any obstacle avoidance zone 
mapping representing the planned path of the vehicle, whereby the obstacle 
avoidance actions to be carried out are assigned to the corresponding obstacle 
avoidance zones. 



3. A method according to claim 1 for a vehicle in motion to find a point (Xioad,Yioad) or 
(Xunioad, Yunioad) in the fixed to ground coordinate system for the initial position of its 
load handling implement in a loading or unloading movement, respectively, in a 
volume of material or other handling objects and where this method employs a 
dynamic terrain model and is characterised by: 

• The vehicle is driven along an in advance planned reconnaissance path towards 
one inside a limiting polygon defined loading or unloading zone; 

• The most suitable point (Xioad,Yioad) for attacking the material volume when 
loading is selected among the elements of the emerging layer Z(l,n) of the 
dynamic terrain model being most near a given initial line or point or otherwise 
most optimal, and where the surface of those elements have been determined with 
a sufficient number of measurements during the vehicle's approach along the 
reconnaissance path from a point where 1) the value [Z(l,n) - Z(2,n)] of a first 
element no n of the dynamic terrain model has been determined with a sufficient 
number of measurements and 2) when the inequality condition A < [Z(l,n)- 
Z(2,n)] is satisfied, where A is a given least height of the terrain surface above the 
reference surface, till the vehicle from this point has travelled a given further 
distance along the reconnaissance path; 

• Furthermore in a loading task this aforementioned search, for nearest or otherwise 
most suitable attack point (Xioad,Yioad) for the vehicle's loading bucket or other 
implement, is confined to such elements no n of the dynamic terrain model for 
which a condition B < [Z(l ,n) - Z(2,n)] is valid, where B is a given least feasible 
loading level above the reference surface per element; 

• In an unloading task the search within the unloading zone for most remote or in 
another way most suitable unloading point (Xunioad, Yunioad) for the vehicle's bucket 
or other implement is confined to such elements of the dynamic terrain model for 
which the inequality [Z(l,n) - Z(2,n)] < C is valid, where C is a given maximum 
height above the reference surface for an element for allowing unloading on this 
element. 



4. A method according to claim 3 to fill a bucket in an automatic loading operation based 
on the information of a material volume derived from a dynamic terrain model and 
where the planning and optimisation of parameters for vehicle and load handling 
implement movements is characterised by: 

• Parameters for the loading path of the vehicle and the lift and tilt movements of the 
load handling implement are determined during the vehicle's movement along an 
approach path between the first detection of a material volume and the arrival to 
the attack point by employing a terrain height profile table, which is based on 
actual terrain according to the emerging layer Z(l,n) of the dynamic terrain model 
for a number of points no i = 0,1,2,3,. .., with corresponding penetration depths 
sg(i) along the planned path of the loading bucket, and where the Z coordinate 
Zioading(i) for each such point no i represents, in a fixed to ground coordinate 
system, an average value of Z(l,n) for elements number n located in a specific 
proximity of the front edge of the bucket; 

• The volume to become loaded is calculated as the volume that will be cut out by 
the bucket for a sequence of its positions k = 0,1,2,3,... in the same fixed to ground 
coordinate system, according to the model for planning the vehicle and its load 
handling implement movements, and from which is obtained an estimate of how 
deep into the material volume the bucket must be penetrating during the loading 
process, and also when lift and tilt movements shall be commenced and terminated 
during the final phase of the loading operation. 

5. A method according to claim 4 for minimising the friction caused by the support 
reaction force on the bucket when the bucket is moved towards and into a material 
volume, characterised by: 

• Minimising the friction is done by controlling a hydraulic pressure to the lift 
cylinders of the load handling implement, where the control parameters are 
optimised in a model based on an estimate of and in order to balance the total 
weight and moment of the load handling implement with bucket and its expected 
loaded volume, as a function of penetration depth s(k), k= 0,1,2,3,..., and the lift 
and tilt movement process of the load handling implement and by employing the 
height profile table Zioading(i), i = 0,1,2,3,..., from the dynamic terrain model. 
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Forfarande i form av intelligenta funktioner for fordon och automatiska lastmaskiner 
gallande kartlaggning av terrang och materialvolymer, hinderdetektering och styrning av 
fordon och arbetsredskap. Patentansokan. 

1. Problem 

Forarlosa fordon som transporters bulkmaterial sasom schaktmassor och malm, har borjat tas i 
bruk inom industrin inom vissa fabriksanlaggningar och ett behov finns aven vad galler bante- 
ring av andra produktslag sasom fasta branslen i form av kol och biomassa samt sand, grus, 
kemikalier och jordbruksprodukter. Transportsystem baserade pa fordon har fordelar framfdr 
automatiska transportsystem baserade pa mera stationara anlaggningar, sasom kranar, traverser 
och transportband, genom att de ar mera flexibla och mindre investeringskravande. 

I nu kanda utffcranden av forarlosa fordon for ovannamnda uppgifter ar fordonen antingen helt 
fjarrstyrda av en operator eller forsedda med en begransad autonomitet sa att de utan operator 
kan navigera utefter en planerad bana, medan fortfarande en operator erfordras for att styra ar- 
betet vid lastning samt for att ingripa och fjarrstyra maskinen vid olika mer eller mindre ovan- 
tade situationer. Vidare kravs som regel att en sadan maskin endast flr upptrada autonomt pa 
fran ovrig trafik och personer avgransade omraden, eftersom maskinen saknar eller endast har 
relativt onoggranna anordningar for att under autonom drift kunna upptacka eventuella hinder 
och andra icke onskade foremal i sin vag. Dessa begransningar medfdr att personalbesparingen 
jamfdrt med en bemannad maskin blir relativt mattlig eftersom en operator i stort sett kontinu- 
erligt maste finnas till hands for att kunna ingripa i den direkta styrningen av maskinen. 

Det finns darfor ett behov av att utoka de forarlosa fordonens autonoma formaga, dels vad gal- 
ler lastnings- och lossningsmomenten av hanteringen, dels vad galler fdrmagan att vid autonom 
drift med hog noggrannhet och sakerhet upptacka hinder och andra icke onskade foremal i kor- 
banan. 



Uppfinningen loser detta problem, vid fordon och automatiska lastmaskiner med lasthante- ' 
ringsdon och system for autonom navigering inom avgrSnsade omraden, genom en med en- 
kombination av en scannande laseravst&idsmatare och ett fordonsburet positionsbestamnings- 
system inmatt dynamisk terrangmodell, dar en sarskild dynamisk terrangmodellsdator, DTM- 
dator, analyserar aktuella matningar mot befintliga modellvarden och darvid kan upptacka och 
med hog noggrannhet registrera och anaiysera ytan av terrang, materialvolymer och andra fore- 
mal och hinder framfbr fordonet och dar positionsbestamningssystemet i tre dimensioner och 
sex frihetsgrader med hog noggrannhet bestammer fordonets och den scannande laseravstands- 
matarens lage i ett jordfast koordinatsystem och fbrutom att ge positionsuppgifter for fordonets 
banstyrning darmed mqjliggor att uppbyggnad och uppdatering av ovannamnda terrangmodell 
och forekommande jamforelser mot tillkommande matningar sker valdefinierat och entydigt i 
ett jordfast koordinatsystem och vartill en sarskild uppdragsdator i fordonet, utg^ende fran av 
DTM-datorn beraknad angreppspunkt och hojdprofil for en lastnings- eller lossningsbana in i 
den uppmatta materialvolymen, beraknar parametrar for fordonets bana och lasthanteringsdo- 
nets rorelse under vissa bansegment inklusive lastningsbanan, samt dar denna uppdragsdator 
aven samordnar och beordrar styrning av fordons och lasthanteringsdon i saval i fbrvag helt 
planerade och darmed statiska banor som i de dynamiskt planerade banoma vars parametrar 
beraknats i uppdragsdatorn utgaende fran DTM -datorns analyser. 



Uppfinningen framgar av efterfdljande patentkrav. 



2. Kand teknik 

De system som idag anvands for autonom styrning av fbrarldsa fordon bygger vanligen pa att 
fordonen framfbrs pa en i fbrvag pianerad bana med hjalp av nagot positionsbetsamningssys- 
tem. Lasthanteringsfunktioner vid arbete med bulkmaterial kan bygga pa att maskinen ar fdr- 
sedd med en eller flera videokameror som via en radiolank ger operatoren en presentation pa 
bildmonitor som underlag for att vid lastning och andra kritiska hanteringsmoment styra maskin 
och redskap med fjarrkontroller. Eftersom operatbren alltid mSste ingripa under vissa delar av 
ett cykliskt hanteringsfdrlopp blir personalbesparingen relativt begransad jamfdrt med en kon- 
ventionell hantering med en operatbr ombord pa fordonet. Vidare saknas i manga fall sakerhet- 
sanordningar for att med tillracklig noggrannhet upptacka och undvika kollision med hinder i 
banan under transportdelen av hanteringsfSrloppet da operatoren normalt ej styr och overvakar 
fordonet, vilket medfdr okade risker alternativt skarpta krav pa yttre bevaknings- och begrans- 
ningsanordningar samt krav pa kapacitetsbegransande trafikseparering vad galler autonomt na- 
vigerande fordon. 

For fordon i form av autOmatiska truckar som anvands i inomhus drift baseras antikollisionssys- 
temen vanligen pa en kombination av akustiska, elektrooptiska och mekaniska sensorer, som ar 
monterade pa maskinen och som med tillracklig sakerhet vart och ett eller tillsammans detekte- 
rar och larmar for hinder i narheten av maskinen. 

I kanda utfdranden av mekaniska hindersensorer bygger de pa att kanna av hinderkontakt med 
en rorlig del, sasom exempelvis en plat, varvid derma del tillats flytta sig en viss stracka relativt 
fordonets ovriga geometri for att ge utrymme for en inbromsning av fordonet fran det dgonblick 
hindret detekteras tills fordonet ar stoppat. For att medge rimliga bromsstrackor med hansyn till 
mojhgheten att utfdra dessa mekaniska hindersensorer maste fordonshastigheten darfbr begran- 
sas till nagon meter/sek. 

I kanda utfbranden av mekaniska hindersensorer ingar ocksa att dessa kannande delar ar place- 
rade nara golvet. F5r att ett sadant skydd ska vara effektivt fdrutsatts att golvet ar nagorlunda 
plant. 

Ultraljudssensorer Si avsedda for att varna for hinder pa nagot stonre avstand an de mekaniska 
hindersensorerna. Eftersom dessa sensorers upptacktsformaga ar beroende av det foremal som 
ska detekteras, sa duger de bast till att detektera solida och storleksmassigt bastanta hinder, sa- 
som en vagg, medan andra hinder, sasom en liten materialvolym pa golvet, kan vara sv^rare att 
detektera. Liksom for de mekaniska sensorerna ar rackvidden ocksa s£ kort att ultraljudssenso- 
rer fungerar bMst vid hastigheter av storleksordningen hogst nagon m/s. 

I inomhusfordon anvands ocksa scannande laseravstandsmatare for att upptacka hinder. I kanda 
utfbranden ar den monterad sa att den verkar i ett horisontellt plan nara golvet. Liksom de me- 
kaniska hindersensorerna kraver denna sensor ett nagorlunda plant golv, men har fbrdelen att 
medge langre inbromsningsstracka an de mekaniska hindersensorerna. 

Pa fordon sasom en hjullastare med ett stort lasthanteringsdon framtill pa fordonet ar anvand- 
ningen av ultraljuds- och mekanisk hindersensor i kanda utforandeformer fdrhindrad av lasthan- 
teringsdonets placering. 

Vid anvandning av scannande laseravstandsmatare som hinderdetektor pa utomhusfordon, fmns 
1 nu kMnda utfbranden begransningar som gbr en sMan sensor mindre effektiv i mSnga fall'. Ett 
framtill monterat lasthanteringsdon ar ivagen for en sensor som arbetar i ett horisontellt plan 
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med avsikt att se hinder framfdr fordonet. For en hogre upp pa fordonet monterad sadan sensor 
och som arbetar i lutning ner mot marken maste beaktas dels att markytan ofta inte ar lika plan 
och slat som golvet i en fabrikslokal varfdr ett mindre hinder kan vara svart att skilja fran mar- 
kytan, dels eftersom fordonen ofta har ett mera energirikt rorelsespektrum i tipp-, roll- och Z- 
led som kan ge betydande och med avstandet snabbt vaxande felbidrag till den scannande la- 
seravstandsmatarens mfitningar. 

Skriften Nr WO 87/02484 fran 1 987 anger ett forarlost fordon som har viss fdrmaga till auto- 
nom lastnmg och lossnmg av enstaka fasta fdremal. Metoden kraver att varje enskilt fdremal 
som ska hanteras ar fdrsett med ett antal reflektorer samt att foremalen har vissa standardmatt 
typ lastpall. Metoden klarar ej lastning av bulkmaterial och fasta fdremal av skiftande och obe'- 
kant form. 

I US patent 5,548,516 fran 1996 anges ett fdrarldst fordon som utdver autonom navigering ba- 
sest pa GPS, trdghetsnavigering och odometerbaserad dodrakning har en scannande laserav- 
standsmatare for att upptacka och undvika hinder. Daremot saknar detta fordon terrangmodell 
och ftinktioner fbr autonom hantering av material. 

I en amerikansk forskningsartikel fran 1999:"Motion Planning for All-Terrain Vehicles- A 
Physical Modeling Approach for Coping with Dynamic and Contact Interaction Constraints- 
IEEE Transactions on Robotics and Automation, Vol 15, No 2, April 1999, beskrivs ett konc'ept 
tor banplanenng for en mobil robot som rdr sig i fri terrang. Konceptet fdrutsatter full kanne- 
dom om terrangens topologi, och problemet med material- och lasthantering behandlas icke 
Lasthantenng behandlas inte heller i en annan forskningsartikel, "Autonomous Robot Naviga- 
tion m Unknown Terrains: Incidental Learning and Environmental Exploration", IEEE Tran- 
sactions on Systems, Man and Cybernetics, Vol 20, No 6, Nov/Dec 1990. Daremot beror denna 
artikel problemet att kartlagga omgivningen med hjalp av en fordonsbaserad terrangsensor. 

US patent 5,974,352 anger ett forfarande f5r att styra en lastskopa med hjalp av lages- och 
tryckkannande sensorer pa lift- och tiltcylindrarna, och som utgaende fran integration av krafter 
och rorelser i lasthantenngsdonets mekanik beraknar gynnsamma lyft- och tiltrdrelser pa sko- 
pan. Forfarandet fdrutsatter en forare eller operatdr som valjer lastningspunkt och som kor for- 
donet till och fran denna punkt samt kdr fordonet under hela lastningsrdrelsen och som styr 
skopan vid paborj andet och avslutandet av lastningsrdrelsen. 

US patent 6,173,215 Bl avser hur ett fbrarldst fordon ska mandvrera da ett hinder har upp- 
tackts. Daremot behandlas inte vilka typer av sensorer som anvands for att upptacka och mata 
m ett hinder. 

3. Figurer 

Fdljande figurer anvands i beskrivningen: 

Fig 1: Begreppstrad. Relationer mellan begreppen fdrarlos, fjarrstyrd och autonom samt auto- 
nom planstyrd och autonom intelligent samt underbegrepp till autonom intelligent. 

Fig 2: Lastmaskin 1 med lasthanteringsdon 14 och lastskopa 142, scannande laseravstindsmS- 
tare 81 fdr att mata in markyta, materialvolymer och hinder och for att ge indata till den dy- 
namiska terrangmodellen 821 samt positionsbestamningssystem 7 med fordonsburen rote- 
rande elektrooptisk sensor 71 och markfasta reflektorer 72. Figuren visar, i ett vertikalsnitt 
var laserstralen traffar en framfdr fordonet 1 befintlig materialvolym 181 . 

Fig 3: Princip fBr laseroptiskt system enligt svenskt patent nr 464 837 for bestamning, i ett jord- 
fast koordinatsystem 41, av ett fordons 1 position i tre dimensioner samt dess kurs- tipp- och 



rollvinklar utgaende fran vinkelmatningar i ett fordonsfast koordinatsystem 42 mot ett antal 

markfasta reflektorer 72 inom den laseroptiska sensorns 71 rackvidd. 
Fig 4: Lagesbestamning i tre dimensioner i ett jordfast koordinatsystem 41 av punkter i terrang- 

en fran ett godtyckligt positionerat och orienterat fordon 1 med scannande laseravst&ndsma- 

tare 81 som mater i ett fordonsfast koordinatsystem 42. 
Fig 5: Avbildning fran dynamisk terrangmodell 821, en variabel Z som fiinktion av koordinater 

i planet X och Y. 

Fig 6: Omrade med grSnser utritade for en materialvolym 181 som skall hanteras och med ex- 
empel pk hinderfri zon 191 samt zoner for spaning 192 och lastning 193, i forvag planerad 
bana for spaning 111, dynamiskt planerad narmandebana 121 fran en vaxlingspunkt 7772 pS 
spaningsbanan till en likasi dynamiskt planerad lastningsbana 1223 med tillhorande dyna- 
miskt planerade rorelser for lasthanteringsdonet inklusive lastskopan, en dynamiskt planerad 
transportbana 124 som omfattar fordonets 1 gang ut ur materialvolymen och &ter till vantela- 
get 110 for vaxling av korriktningen och statiska transportbanor 112 till och fran en loss- 
ningspunkt 1231 med de rorelser av lastskopan som erfordras vid lossning respektive utgang 
ur lossningsmomentet. 

Fig 7: Omrade med granser utritade for en materialvolym 181 som skall hanteras och med ex- 
empel pa hinderfri zon 191 samt zoner for spaning 192 och lossning 194, i forvag planerad 
bana for spaning 777, dynamiskt planerad narmandebana 121 fr&n en vaxlingspunkt 7772 p§ 
spaningsbanan till en lossningspunkt 7237, en dynamiskt planerad transportbana 724 som 
omfattar fordonets 1 gSng ut ur materialvolymen och ater till ett lage for vaxling av korrikt- 
ningen och statiska transportbanor 772 till och fran en i bilden utelamnad lastningsuppgift. 

Fig 8: Blockschema med de for uppfinningen vasentliga omvarldssensorer och datorsystem 
som erfordras ombord pa fordonet 1, innefattande 

1) fram&tseende scannande laseravst&idsmatare 81 som i ett fordonsfast koordinatsystem 42 
detekterar och mater in punkter p& markytan samt pa fbrekommande hinder samt 

2) positionsbestamningssystem 7 som, i ett jordfast koordinatsystem 41, anger fordonets 1 
position i sex frihetsgrader (koordinater x,y och z samt attitydvinklar y (kursvinkel), 3 
(tippvinkel)och 9 (rollvinkel) samt 

3) DTM-datorn 82 for att hantera och bearbeta den dynamiska terrangmodellen DTM 821 dar 
denna dator tar emot matningarna fran den scannande laseravstandsmataren 81 och med 
hjalp av den i sex frihetsgrader angivna lagesuppgiften fran positionsbestamningssystemet 7 
omvandlar den scannande laseravstandsmatarens 81 m&tvarden till koordinater i det jordfasta 
koordinatsystemet for punkter pa markytan, pa materialvolymer samt pa fbrekommande hin- 
der, som darmed bygger upp och uppdaterar en dynamisk terrangmodell 821, och utifran 
denna modell beraknar och till uppdragsdatorn 6 meddelar koordinater for last- och loss- 
ningspunkter samt hqjdprofiler ft)r planering av banor vid lastning fran respektive lossning 
till en befmtlig materialvolym samt att DTM-datorn ocksa kontinuerligt utvarderar kriterier 
for varning och nodstopp vid fbrekommande hinder och darvid sander erforderliga hinder- 
varnings- 9842 och nodstoppsmeddelanden 9841 till styrdatorn 211 samt 

4) uppdragsdator 6 som hanterar uppdragsprogrammet, planerar fordonsbanor och fordonets 1 
rorelse langs dessa banor samt planerar skopans rbrelse vid hantering av last och som sander 
underlag till DTM-datorn 82 i form av spaningsuppdrag 94 med granstabell 941 for spa- 
ningszon 792 och spaningsriktning, 942 for lastningszon 193, lastriktning och lastskopans 
bredd samt hinderdetekteringsuppdrag 95 med granstabell 951 for hinderfria zoner 797 och 
tabell 952 med fordonets hinderskyddsgeometri 795 och som forser sival DTM-datorn som 
fordonsstyrdatorn 211 med styrtabeller 971 for styrning av fordon och lasthanteringsdon, 
samt 

5) styrdator 211 som styr fordonet 1 och lasthanteringsdonet 14 i autonom mod med hjalp av ett 
antal stalldon och avkannare installerade i fordonets styr- och reglersystem utg&ende fr5n 



styrtabell 971 som tillsants styrdatorn fran uppdragsdatorn 6 eller direkt pa hindermeddelan- 
de 984 som genererats av DTM-datorn 82. 1 fjarrstyrningsmod styrs fordonet av operatoren 
som darvid kan fjarrstyra varje erforderligt stalldon i fordonet via styrdatorn samt 

6) radiolank 5 med radiolSnkterminal 51 vid operatbrsplats och 52 ombord fordonet, for att 
sanda parametrar for beordrade banor samt tillfalliga kommandon och fjarrstyrningssignaler 
till fordonet 1 samt for att fr&n fordonet sanda statusinformation och positionsuppgifter till 

7) operatorsplats 3 med MMI (granssnitt manniska/maskin)-dator 31 samt 

8) operator som beordrar och har mojlighet att planera autonoma uppdrag och som kan ga in 
och styra fordonet 1 i undantagsfall, sasom vid larm och systemfel. 

Fig 9: Exempel p& dynamisk narmandebana 121 bestaende av ett inledande cirkelsegment om- 
givet av ett klotoidpar, darefter en rakbana och ett avslutande cirkelsegment ocksa omgivet 
av ett klotoidpar. 

Fig 10: Vasentliga dataprogram, datameddelanden och parameterlistor samt berakningsmo- 
ment, kallor, beroende- och paverkansstruktur samt dataflodets vagar i och mellan DTM- 
datorn 82, uppdragsdatorn 6 och fordonsstyrdatorn 211. 

Fig 11: Uppdrags- och meddelandeutvaxling samt analys och berakningsmoment vid genomfb- 
rande av spanings- och lastningssekvens. Exempel. 

Fig 12: Skelettmodell av lasthanteringsdon 14 med lastskopa 142 samt delar av fordonets 1 
ramfasta mekanik 

Fig 13: .Forenklad modell, uppbyggd av rigida element och pivotpunkter, av den mekaniska 
strukturen som omfattar lasthanteringsdon 14 med lastskopa 142 

Fig 14: Lastningsbana 1223, projektion i det jordfasta koordinatsystemets 41 x/y-plan, angrepp- 
spunkt for lastning 1222, intrangningsdjup s(k) och beraknade medelvarden Z(k) for 
hojdvarden i jordfasta koordinatsystem 41 avseende pukter pa materialvolymens 181 yta ut- 
med en linje av lastskopans bredd tvars lastningsbanans riktning for varje steg k = 0,1,2,3,... 
av lastningsrorelsen och darur uppskattad hqjdprofil z(k) i det jordfasta koordinatsystemet. 

Fig 15: Utskuren volym iskadliggjord i en avbildning med en polygonmodell som genomskar- 
ning av lastskopan 142 i en serie pa varandra foljande lagen i jordfast koordinatsystem 41 
under en tankt lastningsrorelse i en materialvolym 181. 

Fig 16: Rymmande volym dskSdliggjord for tva olika lagen av en lastskopa 142 

Fig 17: Terrangprofil med referensyta 77, materialvolym 181 och hinder 182 med lagret Z(l,m) 
och funktionen Z( 1 ,m) - Z(2,m) 

Fig 18: Fordonets 1 hinderskyddsgeometri 195 i den dynamiska terrangmodellen 821. Den del 
av den hinderfria zonen 191 som avsoks med avseende pa eventuella hinder representeras av 
ett antal av fordonets hinderskyddsgeometri tackta element, och monstret ar skapat utgdende 
fran ett antal pa varandra foljande positioner for fordonets hinderskyddsgeometri i den plane- 
rade banan vid och framfbr fordonet som ar avbildat i sin befintliga position. 

4. Uppfinningens utforande 
Allman oversikt 

I den har foljande beskrivningen av denna uppfinning anvands det kortfattade uttrycket " sys- 
tem" for att avse anordning eller apparat, fbrfarande eller metod eller en kombination av an- 
ordning eller apparat och fbrfarande eller metod. 

Med hanvisning till begreppstradet i figur 1 och dess fbrklaringar nedan avser uppfinningen 
intelligenta funktioner for fordon och automatiska lastmaskiner gallande kartlaggning av terrang 
och materialvolymer, hinderdetektering och styrning av fordon och arbetsredskap. 

Uttrycket ^arrstyrning avser styrning av ett fordon som kontinuerligt eller nara kontinuerligt via 
ett kommunikationsmedium, normalt i form av en radiolank med eventuell bildoverforing, styrs 
av en operator som ej befinner sig i fordonet. 



Uttrycket autonom anvands i betydelsen sjalvstandig. Det avser s&ledes utf&rande verksamhet 
som antingen ar belt automatisk eller atminstone till avsevard del automatisk det vill saga utan 
namnvard mansklig medverkan i denna verksamhet. Ett autonomt fordon ska kunna arbeta 
obemannat, dvs utan att behova mansklig fdrare eller annan operator, vare sig ombord eller vid 
n&gon frist£ende operatSrsplats, for att styra fordonet och manovrera dess arbetsredskap. Om 
manskliga passagerare forekommer ombord, dar dessa utover mojlighet att ingripa i undantags- 
fall och nodsituationer inte deltar i styrningen, kan ett sSdant fordon fortfarande anses vara au- 
tonomt. 

Uttrycket planstyrning anvands om system ft>r autonom arbetsoperation som fbljer en uppgjord 
plan utan namnvard mojlighet till korrigeringar med hansyn till andringar eller uppkommen 
tillgang till tidigare ej Stkomlig eller befintlig information. 

Uttrycket intelligent anvands om system for autonom arbetsoperation som till skillnad fran sys- 
tem for planstyrd autonom arbetsoperation innehaller element som uppskattar tillstdnd i och 
skapar eller uppdaterar modeller av omvarlden och som utgaende fran dessa uppskattningar och 
modeller genererar, simulerar och utvarderar ansats till plan for arbetsoperation, modifierar 
uppgjord plan eller skapar ny plan for arbetsoperation som ar optimal i den meningen att den 
forvantas ge en storre produktion an andra mojliga alternativ och att den kan utforas inom givna 
ramar och gransvarden. Liksom vid planstyrning inneh&ller ett intelligent system element som 
tillser att uppgjord plan foljs och genomfors, genom anvandning och styrning av tilldelade re- 
surser och medel. 

Uttrycket banstyrning avser autonom navigering utefter en uppgjord bana, definierad av ett an- 
tal bansegment med for varje segment erforderliga parametrar sdsom ing&ngs- och utg&ngsposi- 
tion , -hastighet och kursvinkel, ev krokningsparameter samt maxhastighet. Banstyrningen inne- 
fattar normalt ett realtids positionsbestamningssystem, som tillgodoser styrsystemets behov av 
att kunna jamfora uppnatt positions- och rorelsetillst&id med planerade varden. 

Beskrivning av uppfinningen 

Med hanvisning till figur 2, 3, 4, 5, 6, 7, 8 och 18 innefattar upfinningen ett forfarande i form av 
intelligenta funktioner for fordon och automatiska lastmaskiner gallande kartlaggning av 
mark/referensyta och materialvolymer, hinderdetektering och pa sadan information baserade 
intelligenta funktioner for planering och styrning av fordon och arbetsredskap. Uppfinningen 
avser darvid ett forfarande for kartlaggning av ett arbetsomr&de och dari ingaende 
mark/referensyta 77, materialvolymer 181 och hinder 182 med hjalp av fordonsburna sensorer 
varvid ett sadant fordon 1 ar forsett med ett positionsbestamningssystem 7 med en fordonsburen 
roterande elektrooptisk sensor 71 for noggrann positionsbestamning av fordonet i tre dimensio- 
ner X, Y och Z i ett jordfast koordinatsystem 41 och dessutom kurs-, tipp- och rollvinkel, ut- 
nyttjande markfasta reflektorer 72 samt ett system 8 for matning, modellering och analys av 
terrang, materialvolymer och hinder bestaende av en scannande laseravstandsmatare 81 och en 
dynamisk terrangmodell 821, DTM, i en sarskild terrangmodell- eller DTM-dator 82 med al- 
goritmer for att mata in, registrera och analysera mark- eller referensyta, materialvolymer och 
hinder samt, baserat pi denna mer eller mindre kontinuerligt under ett uppdrag insamlade in- 
formation och genomforda kartlaggning, att vid autonom lastning och lossning av material inom 
sarskilt avgransade omraden berakna koordinater for narmaste eller pa annat satt mest lampliga 
angreppspunkt 1222 vid lastning dar mitten av lastskopans 142 framkant avses gd in i material- 
volymen, och uppskatta en for styrningen av lasthanteringsdonet 14 erforderlig hojdprofil for 
lastningsbanan, respective att vid lossning berakna koordinater for mest avlagsna eller pa annat 
satt mest lampliga tomningspunkt 1232 for lastskopan vid lossning samt att vid upptackt och 



farhg narhet av hinder ge varning respective stoppkommando, varvid DTM-datorns spanings- 
och hinderdetekteringsuppgifter ar beordrade fran en uppdragsdator 6, som i sin tur, for ett spe- 
cific uppdrags genomfdrande blivit fdrsedd genom Qversandning av data fran en operatorsplats 
3 med ett operationsuppdrag 9 innefattande uppdragsprogram 91 for den dverordnade styrning- 
en av fordonet under ett uppdrag samt parametrar 92 for statiska bansegment 11 och prototyp- 
parametrar 930 for operationens dynamiska bansegment 12 samt spaningsuppdrag 94 med an- 
befallda zoner och riktningar for spaning, lastning och lossning och hinderdetekteringsuppdrag 
95 med granstabeller 951 for hinderfria zoner 191 samt tabell 952 med hinderskyddsgeometri 
195 for det aktuella fordonet, och dar denna uppdragsdator tar emot meddelanden fran DTM- 
datorn avseende koordinater och lokal terrangmodell for lastnings- respektive Iossningspunkter 
och med hjalp av program 611 - 613 for optimering av fordonsbana och lasthanteringsdonets 
rorelse, samt program 614 for simulering och tabellering av fordonets och lasthanteringsdonets 
rdrelse beraknar och till en fordonsstyrdator 211 oversander styrtabell 971 for aktuellt banseg- 
ment varvid denna styrdator via granssnitt 212 till fordonets elektriska och hydrauliska system 
styr fordonet och dess redskap i planerade banor och rdrelser samt vid hinder patraffade av 
DTM-datorn och pa direkta hindermeddelanden 984 fran denna beroende pa hindrets narhet 
andrar hastighet eller, liksom vid bruten radiolankforbindelse 5 med operatdrsplatsen, stannar 
fordonet och larmar till operatdrsingripande. 

Vid ett forfarande i form av intelligenta funktioner for fordon och automatiska lastmaski- 
ner gallande kartlaggning av terrang och materialvolymer, hinderdetektering och styrning 
av fordon och arbetsredskap ar fordonet 1 fdrsett med ett lasthanteringsdon 14 vari ingar 
en lastskopa 142 eller annat styrbart lastbarande redskap. For planering och dvervakning 
av fordonets arbete finns en operatorsplats 3 med granssnitt manniska/maskin, MMI- 
dator, 31 som med en radiolank 5 har fdrbindelse med fordonets uppdragsdator 6. 1 MMI- 
datom finns for fordonet fdrplanerade operationsuppdrag 9 innehallande ett for varje ope- 
ration specifikt uppdragsprogram 91 som skoter utdelning av uppgifter till olika delsystem 
och som kontrollerar att uppgiftema utfbrs planenligt under uppdragets gang efterhand 
som arbetet framskrider och som aterlamnar initiativet till operatdrsplatsen nar uppdraget 
ar slutfdrt eller om det avbryts av annan anledning. I operationsuppdraget ingar ocksa pa- 
rametrar 92 for statiska bansegment //, prototypparametrar 930 for dynamiska banseg- 
ment 12, spaningsuppdrag 94 med riktningsangivelser och granstabeller for zoner for 
spaning 941, lastning 942 och lossning 943 samt hinderdetekteringsuppdrag 95 med 
granstabeller 951 for hinderfria zoner 191 och tabell 952 med fordonets hinderskyddgeo- 
metri 195 . Infor ett uppdrag sands fran operatorsplatsen 3 ett sadant operationsuppdrag 9 
till fordonets uppdragsdator 6 via radiolank 5. 

I det totala systemet ingar ett positionsbestamningssystem 7. Det anvands for fordonets 1 
navigering, samt for att i ett jordfast koordinatsystem 41 avge position och attitydvinklar 
avseende ett fordonsfast koordinatsystem 42 i vilket det sitter en scannande laserav- 
standsmatare 81 som tillhor fordonets delsystem 8 for inmatning av mark/referensyta 1 7, 
materialvolymer 181 och hinder 182. Positionsbestamningssystemet beraknar, i ett jord-' 
fast koordinatsystem 41, fordonets lage i sex frihetsgrader, dvs x-, y- och z-koordinater 
samt de tre attitydvinklarna y (kursvinkel), 9 (tippvinkel)och q> (rollvinkel). I det jord- 
fasta koordinatsystemet Si exempelvis X-axeln en mot norr riktad vektor i horison- 
talplanet,Y-axeln en vektor Iikaledes i ett horisontalplan, vinkelrat mot X-axeln och riktad 
mot oster. Z-axeln ar en normalvektor till samma horisontalplan och vinkelrat mot bade 
the X-axeln och Y-axeln och riktad uppat, dvs mot zenit. Det fordonsfasta koordinatsys- 
temet 42 ar ocksa ett ratvinkligt koordinatsystem, dar ^-axeln till exempel ar riktad framat 
och utmed fordonets langsrilrtning, ^-axeln riktad i fordonets tvarsriktning och £-axeln ar 



riktad uppat och vinkelratt mot b&de £-axeln och r|-axeln. Det fordonsfasta koordinatsys- 
temets lage och orientering i rymden definieras av positionen (x,y,z) for dess origo och 
dess vridning i forMllande till det jordfasta koordinatsystemet av de tre attitydvinklarna y 
(kursvinkel), 3 (tippvinkel)och <p (rollvinkel). Vinkeln y kan darvid definieras som en 
medurs vridning av det fordonsfasta koordinatsystemet kring dess egen £-axel, sett fr&n 
en punkt p& den positiva delen av n&nnda axel. PS samma satt definieras vinkeln ft som 
en moturs vridning av det fordonsfasta koordinatsystemet kring dess egen ri-axel, sett 
fr&n en punkt p& den positiva delen av namnda axel ,och vinkeln 9 som en moturs 
vridning av det fordonsfasta koordinatsystemet kring dess egen £-axel, sett fran en punkt 
pk den positiva delen av sistnamnda axel 

Ett sadant positionsbestamningssystem 7 kan till exempel utforas enligt de principer som 
anges i svenskt patent nr 464 837 och som for att erh&lla sex fiihetsgrader i positionsbe- 
stamningen utfor vinkelmatningar i sidled och hojdled till ett antal reflektorer 72 kring 
fordonet 1. 

Foreliggande uppfinning ar en utveckling av detta patent genom inforande av en framatse- 
ende scannande laseravst&ndsmatare 81 avsedd for att med hog noggrannhet upptacka och 
mata in terrang, materialvolymer och andra fSrem&I sSsom hinder framfbr fordonet och 
den tillhorande DTM-datorn 82 vars uppgift ar att med hjalp av den i sex fiihetsgrader 
angivna lagesuppgiften fran positionsbestamningssystemet omvandla den scannande la- 
seravstandsmatarens matvarden till koordinater i det jordfasta koordinatsystemet for 
punkter p& markytan, pa materialvolymer samt pa forekommande hinder och att darmed 
bygga upp och uppdatera en dynamisk terrangmodell DTM 821. Utgaende fran DTM kan 
sedan olika analyser ske dels vad galler lampliga punkter till vilka fordonet kan styras vid 
lastning och lossning, dels vad galler val av parametrar for att skapa effektiva rorelser med 
fordon och lasthanteringsdon vid lastning och lossning. Dessutom kan DTM anvandas 
utanfor lastnings- och lossningszonerna for att detektera och ge larm i systemet for upp- 
tackta hinder. 

Vidare ar fordonet 1 anordnat for fjarrstyrning genom att det ar fbrsett med en fordons- 
styrdator 211 med granssnitt till fordonets elektriska system, innefattande granssnitt till 
motor, vaxell&da, fardbroms, parkeringsbroms och fordonets styrsystem, med granssnitt 
till lasthanteringsdonets sensorer och elektriskt styrbara stalldon 14, med granssnitt till ett 
positionsbestamningssystem 7, med granssnitt till operatorsplatsen 3 via radiolank 5, med 
granssnitt till uppdragsdatorn 6 och for hinderskyddsfunktioner aven med granssnitt till 
DTM-datorn 82 med digital terrangmodell 821. 

Fordonsstyrdatorns 211 styrning av fordonet baseras pa en styrtabell 971 som genereras i 
uppdragsdatorn 6 med hjalp av ett program 614 for simulering och tabellering av fordo- 
nets och lasthanteringsdonets rorelse. Denna tabellgenerering utfbrs for varje bansegment 
frin stillastaende eller vaxlingspunkt fran fbregaende bansegment till stopp eller vax- 
lingspunkt till nytt bansegment. For statiskt bansegment 11 genereras styrtabellen darvid i 
uppdragsdatorn utgaende fran en uppsattning fardiga parametrar 92 for statiskt banseg- 
ment 77, medan den for dynamiskt bansegment 12 genereras utg&ende fran en uppsattning 
i uppdragsdatorn berMknade parametrar 931. For berakning i uppdragsdatorn 6 av para- 
metrar for dynamiska banor anvands program for optimering av narmande-, lastnings- och 
lossningsbana 611, 612 respektive 613 vars berakningar bygger pa dels en uppsattning 
prototypparametrar 930, dels matvarden och tabeller som skapats i DTM-datorn 82 i form 
av upptackts-, lastningsbane- och lossningspunktsmeddelanden 981, 982 respektive 983. 1 
DTM-datorn finns en dynamisk terrangmodell DTM 821 som tacker hela arbetsomradet 



med transportvagar och zoner for spaning, lastning och lossning. Vidare mottar DTM- 
datorn kontinuerligt under uppdraget positionsuppgifter frSn positionsbestamningssyste- 
met 7. Vid lastning eller lossning inleds, efter eventuella forberedande statiska banor for 
att komma fram till lamplig narhet av den aktuella lastnings- eller lossningszonen, en 
spaningsbana 111 varunder syftet ar att upptacka en lamplig punkt i material volymen dar 
en lastningsrorelse in i materialvolymen kan paborjas eller dar en lossningsrorelse 1233 
kan utforas. Via uppdragsdatorn 3r DTM-datorn fbrsedd med erforderliga zongranstabel- 
ler 941, 942 och 943 for spanings- 192, lastnings- 193 respektive lossningszon 194 fxhxv 
operationsuppdraget 9. P& grundval av dessa uppgifter avgor DTM-datorn nar fordonet 
befinner sig i spaningszon och p&b6rjar dk aktiv uppdatering av den dynamiska terangmo- 
dellen utg&ende frSn den scannande laseravstandsmatarens 81 avstands- och vinkelmat- 
ningar mot materialvolym 181 och andra ytor inom aktuell lastnings- eller lossningszon. 
Med hjalp av de koordinater och attitydvinklar i det jordfasta koordinatsystemet 41 for det 
fordonsfasta koordinatsystemet systemet 42 som erhalls fran positionsbestamningssyste- 
met 7 transformeras matningarna fr3n det fordonsfasta koordinatsystem 42 i vilket dessa 
matningar primart sker, till positioner i jordfast koordinatsystem 41 varefter resultatet av 
vaije matning kan anvSndas for att uppdatera den dynamiska terrangmodellen. 

Parallel It med denna uppdatering analyserar DTM-datorn 82 ocksa den framvaxande dy- 
namiska terrangmodellen DTM 821 for att hitta narmaste eller mest avlagsna eller p& an- 
nat satt mest optimala angreppspunkt 1222 for lastning respektive tomningspunkt 1232 
ffcr lastskopan vid lossning. Nar en s&dan punkt ar funnen sander DTM-datorn till upp- 
dragsdatorn 6 ett upptacktsmeddelande 981 med koordinater for fordonets position vid 
meddelandetillfallet samt koordinater for den hittade punkten. I uppdragsdatorn beraknas 
d&, utg&ende fran dessa uppgifter fran DTM-datorn samt fran i operationsuppdraget 9 in- 
gaende prototypparametrar 930, med hjalp av uppdragsdatorns program 611, parametrar 

9311 och styrtabell 971 for en dynamisk narmandebana 121, som fran en med hansyn till 
fordonets momentana position lamplig vaxlingspunkt 1112 en bit langre fram i den paga- 
ende spaningsbanan 111 ska leda fordonet till ett lampligt lage, lastningspunkten 1221 el- 
ler lossningspunkten 1231 infor den hittade angreppspunkten 1222 for lastskopans inging 
i en materialvolym respektive tomningspunkten 1232 for lastskopan vid lossning. Darefter 
sander uppdragsdatorn ett vaxlingsmeddelande 972 med koordinaterna for vaxlingspunk- 
ten samt narmandebanans styrtabell till fordonsstyrdatorn 211. Dessutom sander upp- 
dragsdatorn ett rapportpunktsmeddelande 973 till DTM-datorn som avser koordinaterna 
for den punkt i banan dar DTM-datorn ska till uppdragsdatorn avge ett lastningsbanemed- 
delande 982 med koeflficienter 9821 for markplanet vid lastningspunkten och en tabell 
9822 over en beraknad hojdprofil i lastningsbanan 1223 eller vid lossning ett lossnings- 
punktsmeddelande 983 med koefficienter 9831 for markplanet vid lossningspunkten och 
en tabell 9832 med lokal terrangmodell av den inmatta materialvolymen 181 i en omgiv- 
ning av den foreslagna tomningspunkten 1232 for lastskopan vid lossning. Samtidigt fort- 
satter DTM-datorn att analysera den framvaxande DTM for att berakna dessa koefficienter 
och denna hojdprofil eller lokala terrangmodell i den riktning som enligt i operationsupp- 
draget angiven lastnings- respektive lossningsriktning leder in i materialvolymen fran den 
foreslagna angreppspunkten for lastskopans ingang i materialvolymen eller den foreslagna 
tomningspunkten 1232 for lastskopan vid lossning. Nar rapportpunkten natts och detta 
lastningsbanemeddelande 982 sants over fran DTM-datorn beraknas aktuella parametrar 

9312 for lastningsbana i uppdragsdatorn med hjalp av dess program 612 for optimering av 
lastningsrorelse och utg§ende fran prototypparametrar 9302 for lastningsbana samt fran 
DTM-datorn erhillna koefficienter och hqjdprofiltabell. Vid en lossningsuppgift och efter 
mottagning av frfin DTM-datorn erhillet lossningspunktmeddelande 983 beraknas aktuella 



parametrar 9313 for fordonets lossningsrorelser 1233 i uppdragsdatorn med hjalp av dess 
program 613 for optimering av lossningsrorelse och utgziende fr&n prototypparametrar 
9303 for lossningsrorelse samt fr&n DTM-datorn erhallen tabell med lokal terrangmodell. 
Slutligen simuleras fbrloppet i uppdragsdatorn med hjalp av dess program 614 for simu- 
lering och tabellering av fordonets och lasthanteringsdonets rorelse varvid en ny styrtabell 
genereras och sands till styrdatorn som paborjar styrningen av fordonet efter denna nya ta- 
bell sk snart narmandebanan ar avslutad. Nar sedan lastningsbanan 1223 eller lossningsro- 
relsen 1233 ar avslutad sander fordonsstyrdatorn 211 ett redomeddelande 961 till upp- 
dragsdatorn som darvid beraknar parametrar for en dynamisk utgangsbana fran den aktuel- 
la positionen till en punkt varifran banan leder till en punkt dar fortsatta banor kan fblja i 
enlighet med det overordnade uppdragsprogrammet 61. Nar denna bana sedan kdrts och 
uppdragsdatorn Sterfatt initiativet fortsatter hanteringen enligt uppdragsprogrammet med 
nya lastnings-, lossnings- eller transportuppgifter eller till ett vantelage 110. 

Under fordonets 1 rorelse ar DTM-datorns 82 uppgift jamval att jamfora erhallna matvarden 
fr&n den scannande laseravstandsmataren 81 med tidigare kMnd modeil av terrang, materialvo- 
lymer och hinder och darvid prova kriterier for hinderupptackt under alia skeden av autonom 
drift av fordonet. 

Inmatning av mark/referensvta, materialvolymer och hinder 

Den scannande laseravstandsmataren 81 ar placerad relativt hogt, se figur 2, sasom pa for- 
donstakets framkant och riktad fram&t och snett ned&t. Varje str&le utgors av en kort laserpuls 
och dess g&ngtid fram och dter anvands for mining av avstandet mellan lasern och stralens 
traffpunkt i omgivningen. Genom en roterande spegel i scannern sveps dessa stralar i ett plan 
definierat av scannerns mekanik. Det plan vari stralarna sands ut Mn den scannande laserav- 
standsmataren ar parallellt med det fordonsfasta koordinatsystemets 42 r^-axel men ar vinklat 
ner med vinkeln 0, fr&n ett plan parallellt med det fordonsfasta koordinatsystemets axlar § och 
T|. Strilarna traffar omgivningen i form av mark, materialvolym eller annat forem&l, sasom ett 
hinder, i punkter som bildar en kurva som p& plan mark utgors av en rat linje vinkelrat mot for- 
donets 1 langsaxel och sett i ett tvarsnitt i punkten P (figur 2). Den scannande laseravstandsma- 
taren 81 mater vinkel a, se figur 4, i det lutande planet mellan fordonets riktning rakt forut och 
till ett antal punkter pa omgivningen utmed ovannamnda kurva samt avstand R Mn scannern 
till varje sadan punkt P. 

Ortsvektorn X= r\ 9 Q for positionen i det fordonsfasta koordinatsystemet 42 av varje sa- 
dan punkt kan nu beraknas med hjalp av dessa matvarden a och R, den scannande la- 
seravstandsmatarens 81 position (£o t rio, <^>) i det fordonsfasta koordinatsystemet samt den scan- 
nande laseravst&ndsmatarens lutningsvinkel p i forh&llande till detta systems ^/rj plan: 

4 = 4° + R cosacosP 1 

Ti=Tio + Rsina \ (1) 

C, = <^o + R cosasinp J 

Med dessa koordinater i det fordonsfasta koordinatsystemet samt utgaende fran den sex fri- 
hetsgraders positionsuppskattning som erhalls av det fordonsbuma positionsbestamningssyste- 
met 7 kan darefter koordinaterna i det jordfasta koordinatsystemet 41 for varje av den scan- 
nande laseravstindsmataren inmatt punkt P beraknas. Fran positionsbestamningssystemet 7 
erh&lls siledes den sex frihetsgraders positionsbestamning bestaende av ortsvektorn X = (X, Y, 
Z) och attitydvinklarna & och q>, som kan anvandas i transformationsmatrisen M(i|/, cp): 



M( V , 3, <p) = 

f cosycosS, sinycos&, sin» 1 

= | -simj/cosq) + cosij;sinSsin9, cosvj/cosq) + sinvj/sindsincp, - cosSsincpl (2) 

L-simj/sincp - cosv|/sinScos9 / cosi|/sinq) - sinysinScosq), cosOcoscpJ 

Ortsvektorn xias = (xias, ytas, zias) i det jordfasta koordinatsystemet 41 for den inmatta punkten P 
kan nu beraknas som 



Xias = X + X* M(\|/, 3, 9) (3) 

Vaije matning med den scannande laseravstSndsmataren 81 resulterar saledes i en tre dimen- 
sioned koordinatbestamning i det jordfasta koordinatsystemet 41. Berakningarna utfors i DTM- 
datorn 82, och dessa koordinater anvands till jamfbrelse med en dynamisk terrangmodell 821 i 
denna DTM-dator, sasom for att kunna upptacka ett nytt hinder, for olika berakningar av tillk- 
omna materialvolymer etc samt for att vid behov uppdatera den dynamiska terrangmodellen. 

En s&dan terrangmodell 821 kan bygga pa ett kvadratiskt rutnat med kvadratsidan d, och d^r en 
ruta betecknas ( i, j ) varvid dess fyra horn har koordinaterna i planet X/Y: 

nedre vanstra hornet: ( i-1, j-1 )d 
nedre hogra hornet: ( i- 1 , j )d 
ovre vanstra hornet: ( i, j-1 )d 
6vre h(3gra hornet: ( i, j )d 

Mittpunkten for en ruta betecknad ( i, j ) har koordinaterna i planet X/Y: 

fXi = (i - 0.5)d, 1 < i < imax (5a) 
\ 

{ Yj = (j - 0.5)d 5 1 < j < jmax (5b) 

Varje matning Xias kan da jamfbras med eller uppdatera terrangmodellen 821 i rutan ( i, j ) dar 
dessa index i och j bestams av villkoren 

j( i - 1 )d < xias < id (6a) 

l(j-l )d<yias< jd (6b) 
Den dynamiska terrangmodellen DTM 821 ska fungera i varje punkt av hela arbetsomradet dels 
for jamfbrelse med nya matningar (hinderdetektering), dels for berakning av koordinater 9811 
och 9812 for optimala angreppspunkter 1222 for lastskopans ingang i materialvolymen 181 
respektive tbmningspunkter 1232 for lastskopan vid lossning samt optimala lastningsbanor 
1223 och lossningsrtirelser 1233 av fordon 1 och lasthanteringsdon 14, innefattande volym- 
berakningar av lastad volym respektive utrymme for lossning av material for olika ansatta 
parametrar for dessa rorelser. Vissa delar av DTM kan vara uppgjorda a priori medan andra 
baseras eller uppdateras ocksS i viktiga lager av gjorda matningar med den scannande la- 
seravst§ndsmataren. Till varje ruta (i, j) i DTM, 1 < i < imax och 1 < j < jmax kan ett visst 
ordningsnummer n beraknas sa att mot varje n svarar entydigt en viss ruta (i, j) och mot varje 
ruta(i, j) svarar samma tal n: 

f i-imax+ j om jmax < imax 1 

n = i \ (7a) 

li + j-jmax om imax < jmax J 



(4a) 
(4b) 
(4c) 
(4d) 



eller omvant 

fheltalsdelen av braket n/imax om jmax < imax ] 

1 = i > 

In -j j max om imax < jmax J 

fn-iimax om jmax < imax 1 



(7b) 



i 



> (7c) 



Iheltalsdelen av braket n/jmax om imax < jmax J 

Olika lager kan anvandas i DTM for att skilja pa olika slag av zoner och data i DTM Se figur 
17. Med beteckningen Z(LAG, n) avses Z-koordinat i lager LAG for element n i DTM. I det 
fSljande anvands: 

Lager 0. Indexnummer 

Lager 1 . Z(l, n) ar baserat pa matningar enbart fran fordonets aktuella fard i en bana for att 
upptacka och mata in referensyta 17, hanteringsobjekt 180, materialvolymer 181 
eller hinder 182. 

Lager 2. Z(2, n) representerar referensytan 1 7 utan hanteringsobjekt, materialvolymer, kanda 
och okanda hinder. 

Lager 3. Z(3, n) avser hanteringsobjekt, materialvolymer och kanda hinder for vilka ingaen- 
de Z-varden for elementen i modellen bygger pa matningar fran tidigare uppdrag 
inom arbetsomradet eller pa annat satt inmatade grunduppgifter och att darvid vad 
galler hindervarden fran eventuella matningar mot tidigare icke kanda men efter 
upptackten borttagna hinder har rensats bort och ersatts med varden som avser 
samma element utan okanda hinder. 

Lager 4. Z(4, n) ar ett markeringsfalt ffir hinderfri zon 191 , varvid Z(4, n) = 1 betyder att 
elementet ligger i hinderfri zon. 

Lager 5. Z(5, n) = 1 betyder att elementet ligger i spaningszon 192. 

Lager 6. Z(6, n) = 1 betyder att elementet ligger i lastningszon 193. 

Lager 7. Z(7, n) = 1 betyder att elementet ligger i lossningszon 194. 

Matvarden avseende element n kan lagras pa flera olika satt, beroende pa anvandningen: 

• Senast inkomna Z-varde, betecknat Z-i (LAG, n), lagras. Det lagrade vardet betecknas 
Zo(LAG,n) 

• Ett glidande medelvarde av de k senaste matningarna lagras och betecknas har Zo (LAG, n), 
dvs 

Zo (LAG, n) =[ Z-i (LAG, n) + Z-2 (LAG, n) + ... + Z-k (LAG, n)] / k (8a) 

• Ett rekursivt filter med den erfarenhetsmassiga filterkonstanten y, 0<y<l anvands for att 
uppdatera lagrat varde Zo (LAG, n) med senaste matning Z-i (LAG, n). Filtret initialiseras har 
med : Zo (LAG, n) = Z-i (LAG, n) forsta gangen en matning avser element (n), sedan tillam- 
pas foljande formel 

Zo (LAG, n) = yZo (LAG, n) + (l-y)Z-i (LAG, n) (8b) 

Denna metod ar lamplig om man, som i det aktuella fallet, raknar med att erhalla ett stort antal 
matningar for varje element (n). 



Kriterium for hinderdetekterine 



Autonom korning tillats i hinderfria zoner 191 samt inom lastnings- 193 och lossningszon 194 
TillhSnghet av ett element i hinderfri zon utesluter omsesidigt tillhorighet i lastnings- eller 



• • • 



lossningszon. Hinderdetekteringsfimktionens syfte ar att i varje element n dar Z(4,n) = 1 och 
som ligger inom eller i en viss narhet av fordonet i sin aktuella eller planerade position testa 
hypotesen att kriteriet H < [Z(l,n) - Z(2,n)] ar uppfyllt for en minsta hinderhojd H. 

Genom att anvanda skillnaden Z(l,n) - Z(2,n) erhaller man vid ojamn referensyta noggrannare 
matmng av materialvolymer och hinder. Se figur 17. Beslut om hinder fdreligger eller ej i ele- 
ment n kan baseras pa nagon form av statistisk hypotesprovning med givna risker for att fatta 
tel beslut genom att godta att hypotesen ar sann utan att det fbreligger hinder i elementet re- 
spektive att forkasta hypotesen trots att det finns ett hinder i elementet. Nar val beslutet Mr fattat 
kan man lagga m en fast hindermarkering i lagret 3 avseende det aktuella hindret. 

Uppbyggnad och und erhall av materialvolvmsmodelleir 

Nar fordonet under spaningsbana 111 kommer in i spaningszon 192 anvands de matningar som 
avser element inom lastnings- 193 eller lossningszon 194 for att bygga upp och underhalla ma- 
tenaivolymsmodellen inom zonen. Primart ar syftet att skapa underlag for aktuell narmande- 
121 samt lastningsbana 1223 eller lossningsrorelse 1233, men genom att spara matningar till 
kommande uppdrag erhaller man en dynamisk modell som kan ha vissa fel eftersom material- 
volymens 181 form kan ha andrats under operationen efter matningsserien i spaningsbanan 
Samtidigt kan dock intilliggande omraden ha blivit uppdaterade och totalt sett kan denna 
modell anvandas for planering av kommande uppdrag. Genom att efter varje uppdrag lagga in 
aktuella matningar fran det avslutade uppdraget i lager 3 har man dar en aktuell material- 
volymsmodell i DTM for alia lastnings- 193 och lossningszoner 194. 

Med en rutstorlek av 0.33 * 0.33 m for varje element i DTM tacks en yta av 10 ha med cirka en 
miljon rutor. Om man fSr varje ruta lagrar 32 byte index, Z-varden, dataalder- och noggrann 
hetsuppgift i den dynamiska terrangmodellen 821 erfordras ett lagringsutrymme av 32 Mbyte i 
DTM-datorn 82 for denna modell och kan medge en upplosning av cirka 1/64000 i Z-led. 

Berakning av for lastskopan lamolig angrep pspunkt 1222 vid lastning eller tomningsnunkt 1 9 37 
vid lossning 

Flera olika faktorer paverkar valet av angreppspunkt for lastning. Korstrackan inom spanings- 
och lastmngszon 193 for att fdra fordonet till ett Iage, lastningspunkten 1221, sa att lastskopans 
142 framkant befinner sig vid den avsedda angreppspunkten 1222 for lastning har betydelse 
eftersom det ar angelaget att minimera totala transportstrackan under ett uppdrag. Vidare bor 
man valja lastning sa att fdljande lastningsrOrelser inte hindras genom att kvarlamnat material 
hgger i vagen. Dessa faktorer galler ocksa vid lossning. Ett salt att astadkomma maximal rorel- 
sefrihet for efterfoljande dynamiska narmande- och transportbanor liksom lastningsbanor och 
lossmngsrorelser ar att strSva efter en rak front i materialvolymen genom att valja angrepp- 
spunkt for lastskopans ingang i en materialvolym vid lastning respektive tomningspunkt f8r 
lastskopan vid titaning sa att awikelserna mellan framkanten pa materialvolymen och en rat 
linje blir sa sma som mojligt efter varje hantering i materialvolymen. Ett ytterligare onskemal ar 
att undvika lastning mot alltfor obetydliga materialrester inom lastzningszonen. 

En metod for att astadkomma en mojligast rak front pa materialvolymen och samtidigt minin- 
mera transportavstanden ar att valja angreppspunkt 1222 for lastning, och tomningspunkt 1232 
for lastskopan vid lossning, efter frontens minsta respektive storsta avstand till en rat linje som 
har samma nktning som den tankta linje som materialvolymens front onskas anpassad till 
For DTM har tidigare definierats att Z(6,n) = 1 betyder att elementet ligger i lastningszon 193 
och Z(7,n) - 1 betyder att elementet ligger i lossningszon 194. 



Troskelnivaer Hiasm och Hiossn pa minsta lastningsvarda volymhqjd respektive hogsta fyllda vo- 
lymhqjd for lossning anvands for att undvika att alltfor sma spillhogar, materialrester och 
ojamnheter i den befintliga materialvolymen ger en slumpartad styrning av hanteringen. 

Lampligaste angrepps- respektive tomningspunkt 

a) baserat pa narmaste resp mest avlagsna punkt i materialvolymen raknat fran en punkt eller 
linje: 

Nar fordonet 1 for en lastningsuppgift kor framat pa spaningsbana 111 och b6rjar narma sig den 
aktuella materialvolymen 181 inom lastningszonen 193 sa kommer, under fbrutsattning att det 
finns material kvar att lasta, matningar att borja avse element av DTM 821 inom lastningszonen 
med en h6jd over troskelnivan for lastning. For att vid situationer med ett flertal for lastning 
lamphga element i DTM undvika att endast det forsta element som medfdr handelsen att det 
mats in med trdskeloverskridande h6jd anvands som angreppspunkt fbr lastning fordras att for- 
donet framfdrs ytterligare en pa fdrhand bestamd stracka pa spaningsbanan efter denna handel- 
se. Slutpunkten pa denna stracka benamns upptacktspunkt 1111 . Vid upptacktspunkten har 
darvid antingen ett flertal element blivit uppmatta och kan anvandas fdr val av angreppspunkt 
for lastning eller sa ar det fdrst upptackta elementet ensamt i en tillrackligt stor omgivning sa att 
det darfbr kan anvandas som enda element for att bestamma koordinater for angreppspunkten 
fdr lastning 1222. Pa motsvarande satt kan en upptacktspunkt for lossning beraknas. Ett kriteri- 
um for uppndende av upptacktspunkt vid lossning ar att fordonet hunnit fdrflytta sig en given 
stracka sedan matningar borjat komma avseende element inom DTM utan utrymme kvar fdr 
lossning, alternativt att ytan ar torn varfor spaningsbanan kan avbrytas nar lossningsytans bortre 
grans med erforderlig marginal blivit passerad av den scannande laseravstandsmatarens 81 in- 
matningar. Lossningen kan paborjas vid dess bortre grans. 

Vid upptacktspunkten ar det saledes mojligt att stalla upp de binara belaggningstabellema 
Qiasm(i j) och Qiossn(i j) med ekvationerna: 

fO om[Z(l,n)-Z(2,n)]<Htatn ] 

Qlastn(n)= i } ( 9a ) 

U OmHlastning^fZCl.^-ZCZ.n)] J 

resp 

fO omHi OSS ning<[Z(l,n)-Z(2,n)] ] 

Qlossn(n)= { \ (9 b -) 

ll om[Z(l,n)-Z(2 ) n)]< Hiossn J 

F6r en normal till den raka front som man vill uppratthalla anvands, se figur 6 och 7, en fot- 
punkt 1931 med koordinaterna ( Xo, Yo ) och en indikeringsvektor 1932 med komponentema ( 
Xn, Yn). Som angreppspunkt for lastning valjs da med en standardformel ur analytisk geometri 
vid lastning och lossning det element n = niastn respektive n = niossn med koordinaterna (Xiasu., 
Yiastn) och (Xiossn, Yiossn) som ligger narmast respektive langst ifran en linje vinkelrat mot denna 
indikeringsvektor och genom fotpunkten 1931, och dar element niast ocksa uppfyller bivillkoren: 



for lastning 



|Qlastn(niastn) =1 (10a) 
lZ(6, niastn) =1 (105) 



respektive att element niossn for lossning ska uppfylla villkoren 



fQlossn(niossn) — 1 



(11a) 



[Z(7, niossn) = 1 



(lib) 



b) baserat pa nSrmaste resp mest avlagsna punkt i en cell som ingar i en ordnad foljd: 
I detta alternativ ingir varje element n for vilket Z(6,n)=l eller Z(7,n) = 1 i en ordnad foljd N= 
1,2,3,..., NMAX av celler varvid r(N,n) = 1 betecknar att element n ing&r i cell N. Vid lastning 
och lossning utokas darvid bivillkoren (10) respektive (11) med 



dar cell N ar den cell som for tillfallet ar aktuell for lastning/lossning. 

Bangenerering vid ingang i och utgSng ur lagringsyta med materialvolym 

Ett operationsuppdrag 9 som innefattar lastning eller lossning forutsatts innehalla minst en i 
forvag planerad och sSledes statisk spaningsbana 111 som fordonet 1 skall folja medan dess 
sensorer mater in och analyserar den materialvolym 181 varifr&n eller till vilken lastning resp 
lossning skall ske, se figur 6 och 7. Vid fordonets fard utefter denna spaningsbana erhalls darfor 
vid upptacktspunkten 1111 koordinater fbr en angreppspunkt 1222 for lastskopans 142 ingang i 
en materialvolym vid lastning, respektive tomningspunkt 1232 fbr lastskopan vid lossning, som 
ett resultat av analysen i DTM-datorn 82 med hjalp av ovan redovisade villkor och kriterier av 
den under fordonets genomgang av spaningsbanan uppdaterade dynamiska terrangmodellen 
821. Darvid skickar DTM-datorn ett upptacktsmeddelande 981 till uppdragsdatorn 6 med er- 
hallna koordinater for den aktuella angreppspunkten for lastskopans ingang i en materialvolym 
vid lastning eller tomningspunkten for lastskopan vid lossning. Med kannedom om den tid i 
systemet som erfordras fbr att, i uppdragsdatorn behandla den erhallna informationen i form av 
att r&kna ut parametrar 9311 for den dynamiska narmandebana 121 som kan bestammas i detta 
lage och pa basis av dessa parametrar berakna och vidarebefordra styrtabeller 971 avseende 
fordonets bana och fordonets rorelse under detta bansegment, kan darefter laget for en vax- 
lingspunkt 1112 bestammas, vid vilken fordonets bana och rorelse kan overgS fran spaningsba- 
nan till det nu aktuella dynamiska bansegmentet for narmandebanan. Saledes erfordras vid 
upptackt av angreppspunkt for lastskopans ingang i en materialvolym vid lastning eller tom- 
ningspunkt for lastskopan vid lossning att en dynamisk narmandebana beraknas for att fbra for- 
donet fran vaxlingspunkten fram till ett lage, lastningspunkten 1221, dar lastningen just ska 
paborjas med maskinen redo for lastning med lastskopan 142 sankt till avsedd niva med fram- 
kanten i angreppspunkt 1222 fbr lastskopans ingang i en materialvolym eller vid lossning med 
fordonet positionerat i en lossningspunkt 1231 sa att lastskopan kan ga in med lamplig hdjd pk 
tomningspunkten 1232 for lastskopan fbr att kunna fullgora den aktuella lossningsrorelsen 1233 
med lasthanteringsdonet 14. Koordinaterna (Xc, Yc, Zc) for fordonets position i lastningspunk- 
ten beraknas utgaende fran angreppspunktens koordinater med kannedom om fordonets och 

lasthanteringsdonets geometri och aktuella riktning V}/c. P& motsvarande satt beraknas dessa 
koordinater for fordonets position i en lossningspunkt. 

Eftersom det ar sannolikt att den valda lastnings- eller lossningspunkten inte befinner sig rakt 
framfor fordonet och pa spaningsbanans forlangning sa kravs att den dynamiska narmandeba- 



T(N, niastn) = 1 



(10c) 



T(N, IUossn) = 1 



(11c) 



nan 121 p& vagen Mn v£xlingspunkten 1112 dels forskjuter fordonet i sidled, dels leder fordo- 
net fram till avsedd riktning i lastnings- 1221 eller lossningspunkten 1231. Saledes erfordras en 
mer- eller mindre s-formad bana. Genom att vid bangenereringen anvanda saval klotoid-, cir- 
kelbagsformade som raka bansegment, dar klotoidsegmenten innebar att banans radie varierar 
kontinuerligt fiin rakbana till minsta krokningsradie, kan man astadkomma en stor variation av 
sadana banor med sma styrfel.En enkel modell av mattlig komplexitet som fungerar bra, se fi- 
gur 9, bestar av tva krokar och en mellanliggande rakbana. I den forsta kroken genomgar banan 
en kursandring med vinkeln ai och i den andra kroken vinkeln a2. Varje krok bestar av ett klo- 
toidpar samt, for stora ai och OL2, av en cirkelbage inlagd mellan den krokande och ratande 
klotoiden i s&dana krokar. For en enkel bana utan hinder och dar startpunkt och andpunkt ar 
givna i form av tv&dimensionella koordinatvektorer och kursvinklar Xa, V(/a resp Xc, V|/c sk be- 
star en enkel formulering av problemet att berakna banans utseende av tre ekvationer, en for X- 

koordinat, en for Y-koordinat och en for kursvinkel V|/, Formuleringen motsvarar foljande vari- 
abler och ekvationer: 

Xa = (Xa, Ya, Za) och \}M &r koordinater och kursvinkel i det jordfasta koordinatsystemet 
41 for fordonet 1, specifikt dess fordonsfasta koordinatsystem 42, i vaxlingspunkt 1112 
spanings/narmandebana. 

Xc = (Xc, Yc, Zc) och l|/c ar koordinater och kursvinkel i det jordfasta koordinatsystemet 
41 for fordonet 1, specifikt dess fordonsfasta koordinatsystem 42, i lastnings- 1221 re- 
spektive lossningspunkt 1231. 

De tre ekvationerna kan skrivas (A = skalfaktor): 

7 

Xc - Xa = X(k), vektoriell ekvation i tva dimensioner X och Y (12a) 
k=l 
7 

V|/c- V|/a = 2 \\j(k) (12b) 
k= 1 

varvid den tvadimensionella vektorn X(k) och vinkeln V|/(k) ar bidraget i koordinaterna X ochY 
respektive kursvinkel y fran vardera av bansegmenten nr k = 1, 2, 3,.. .,7. 

Var och en av den sammansatta kurvans tv& krokar, bestdr siledes av en krokande och en ratan- 
de klotoidkurva samt, om totala kursandringen ai i kroken nummer "i" ar storre an ett varde ao, 
en mellan de bada klotoidsegmenten inlagd cirkelbage med krokande vinkel ac = ai - ao 

Vi anvander vektorn klot(M,Si) for den krokande klotoidkurvan i krok nr i som funktion av 
parametern Si och med/mot-faktorn Mi 



u = Si u = Si 

klot(Mi, Si) = [J cos(u 2 /2) du, Mi J sin(u 2 /2) du] 
u=0 u=0 



(13a) 



och vektorn cirk(Mi,ccc) for cirkelbagen som flinktion av dess krokande vinkel ac och 
med/mot-faktorn Mi 



cirk(Mi,(Xc) = [sinac, Mi(l-cosac)] (j 3b ) 

dar 

rv oti om on < Oto 

].- (130 
l v ao om ceo < ai 

f 1 for medurs vridning i krok nummer i for vaxande Si 

Ml = \ (13d) 
l -1 for moturs i d:o 

Vi anvander foljande beteckning for tvadimensionella matriser for koordinattransformation 

T cosiyi -sin\|/i 1 

M(\|/i)= i | (14) 

L sin\j/i cosvj/i J 

De sju delsegmentens bidrag till termerna i ekv (12a) och (12b) kan nu stallas upp For del- 
segment 1-3 och 5-7 anvands beteckningarna Mi respektive M2 for deras medmotfaktorer och 
beteckmngarna ai, Si och 02, S2 fdr vinklar och argument till deras klotoidvektorer. 

Delsegment 1. Krokande klotoid i forsta bankroken 

X(l) = kJot(Mi,si)*M(i|M) (15a) 



fo.5Mi-ai omai <a 0 
lo.5Mi-ao om ao<ai 



(15b) 



Delsegment 2. Cirkelbage. Utesluts om ai < tto 

X(2) = cirk(Mi, ai - a 0 )*M(\(/A+0.5Mi-ao) (16a) 
vj/(2) = Mi (ai - a 0 ) (16b) 

Delsegment 3^Ratande klotoid. Raknas med hjalp av att i tva ortogonala riktaingar spegelvan- 
da vektorn fdr krokande klotoid fran den punkt dar banan overgar fran klotoid till rakbana 

X(3) =klot(-Mi, Si)*M(vj/a+Mi ai) (17a) 

V|/(3) = V(/(1) (1?b 



Delsegment 4. Rakbana, kursandring noli. Langd = LNGD A dar A = skalfaktorn, gemensam 
for hela kurvan. 



X(4) = (L, 0)*M(l|/A+ Mi ai) 



(18a) 



M/(4) = 0 

Delsegment 5. Krokande klotoid i andra bankroken 



(18b) 



X(5) = klot(M2, S2)*M (v|/a+ Midi) 
f0.5M2-a2 oma,2<ao 



(19a) 



V|/(5) = { 



(19b) 



l0.5M2-oto om a 0 < OU 



Delsegment 6. Cirkelb&ge. Utesluts om Ct2 < ao 



X(6) = cirk(M2 5 ai - Oto)*M (\}M+ Miai+0.5M2(X2) 



(20a) 



v{/(6) = M2-(a2 - ao) 



(20b) 



Delsegment 7. Ratande klotoid. Raknas med hjalp av att i tva ortogonala riktningar spegelvan- 
da vektorn for krokande klotoid fran banans andpunkt med kursvinkel VJ/c. 



I uppdragsdatorn 6 loses ekvationssystemet (12) genom ansats av de bSda olika mqjliga kombi- 
nationerna av medurs och moturs gang i forsta respektive andra bankroken samt ansats av ett 
antal olika startvarden pa variablerna LNGD, ai och Ct2 , varvid konvergens provas i ekv (12) 
vid ett antal iterationer av numerisk losning av icke linjara ekvationssystem, sasom med 
Newton-Raphsons metod. I den beraknade banan kan fordonet 1 kora banan sdval framlanges 
som baklanges. 

Optimering av lastningsrorelse utg&ende fr&n terrangmodell och model! av lasthanteringsdonets 
och skopans mekanik 

Nar rapportpunkten 1211 natts och lastningsbanemeddelande 982 sants over fr^n DTM-datorn, 
anvands detta meddelandes data i form av koefficienter 9821 for markplanet vid lastningspunk- 
ten samt hqjdprofiltabell 9822 for att i uppdragsdatorn 6 berakna parametrar i en dynamisk 
lastningsbana 1223. Darvid beraknas med vilken hastighet och hur djupt in i materialvolymen 
181 som lastskopan 142 ska foras och vilken rorelse lastskopan ska utfora i lyft- och tippled vid 
fordonets 1 gang in i materialvolymen for att lasta avsedd eller maximal mangd av materialet pa 
minsta mqjliga tid med beaktande av bivillkor som att slirning, overbelastning och spill ska 
undvikas. 

Modell av markplanet i en omgivning av lastningspunkten 

For berakning av lastskopans 142 rorelse i det jordfasta koordinatsystemet 41 behovs en upp- 
skattning av det fordonsfasta koordinatsystemets 42 position i sex frihetsgrader i det jordfasta 
koordinatsystemet 41 for varje lage av fordonet 1 i lastningsbanan 1223. 



X(7) = klot( - M2, S2)*M(V|/c) 



(21a) 



V(7) = V(5) 



(21b) 



• « 

• • • 

• • • 

• • • • 
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Genom att mtrangningen i materialvolymen 181 normalt bara ar en relativt kort stracka, typiskt 
1 - 3 meter, sa kan en enkel plan yta anvandas som modell och dess fel i fdrhallande till den 
verkliga markytans topologi kan i praktiken fdrsummas. Vi antar s&ledes att fordonets hjul 
kommer att rulla pa denna plana yta under hela lastningsfdrloppet. En ekvation for markplan- 
modellen i en omgivning av lastningspunkten 1221 med koordinaterna (Xc, Yc) blir da: 

XXn + YYn + ZZn = C (22) 

En praktiskt anvandbar uppskattning av koefficienterna Xn, Yn och Zn samt konstanten C kan 
beraknas med hjalp av DTM 821 for en mangd punkter pa referensytan / 7 i en omgivning av 
lastningspunkten 1221. Minsta kvadratmetoden kan anvandas fdr berakningarna om man har 
minst 5 representativa element ur DTM, och heist en tiopotens fler, vilket med ovan angivna 
storlekar pa elementen i DTM inte bdr vara nagot problem i de fiesta fall. Dessa berakningar i 
DTM-datorn 82 utfdrs med aktuella varden i DTM innan fordonet kommer fram till den rap- 
portpunkt 1211 pa den dynamiska narmandebanan 121, dar lastningsbanemeddelandel 982 ba- 
serad I pa aktuella matningar av terrang och materialvolym 181 ska sandas over till uppdragsda- 
tom 6 for berakmng av parametrar i den dynamiska lastningsbanan 1223. Nar i detta meddelan- 
de ingaende koefficienter 9821 for markplanet vid lastningspunkten ar oversanda till uppdrags- 
datorn, kan uppdragsdatorn berakna en transformationsmatris M(vj/c, <p c ) fdr lastningsfdrlop- 
pet for att enhgt (3) omvandla koordinater i det fordonsfasta koordinatsystemet 42 till koordina- 
ter i det jordfasta koordinatsystemet 41. Fdr denna plana yta galler fdr en bana fran lastnings- 
punkten 1221 vid kord strScka s i lastningsbanans riktning \j/ c : 

|X(s) = Xc + s cos(i|/ c ) (23a) 

lY(s) = Yc + s sin(v|/ c ) (23b) 

Tvars banan i n-axelns riktning galler for en stracka r fran lastningspunkten 1221: 

|X(r) = Xc - r sin(y c ) (24 a ) 

lY(r) = Yc + r cos(v|/c) (24b) 

En uppskattning av Z(s) som en funktion av kord och som projektion av lastningsbanan 1223 pa 
x/y-planet raknad stracka s langs och en stracka r tvars banan fran lastningspunkten 1221 kan 
nu beraknas ur (22), ekvationen fbr modellen av referensytan 17 

Z(s) = [C - X(s) Xn - Y(s) Yn]/ Zn ( 25 a ) 

respektive 

Z(r) = [C - X(r) Xn - Y(r) Yn]/ Zn (25 b) 

Fdr ett fordon 1 som vid mattliga lutningar kan antas sth om inte i vag sa dock plant pa underla- 
get invid lastningspunkten 1221 kan tipp och rollvinklar 9c resepektive q>c fdr ett fordonsfast 
koordinatsystem 42 uppskattas: 



ur ekvationerna 23 a) och b) samt (25a): 
tan(9c) = dZ(s) Ids = - Xn i 
rna 24 a) och b) samt (25b): 

tan((p e ) = dZ(r) /dr = Xn sin(v|/ c ) + Yn cos(i|/c) (26b) 



tan(Sc) = dZ(s) Ids = - Xn cos(vj/c) - Yn sin(yc) (26a) 
ur ekvationerna 24 a) och b) samt (25b): 



Materialvolymens 181 hojdprofil 1811 i angreppspunkten 1222 

Utg&ende frSn den i DTM 821 inmatta del av materialvolymen 757 som forvantas kunna bli 
berOrd av den forest&ende lastningsrorelsen kan i DTM-datorn 82 beraknas en hojdprofiltabell 
9822 i jordfasta koordinater 41, Genom att l&ta en vektor s i horisontalplanet och riktad i angi- 
ven lastningsriktning v|/c samt en vektor Z i Z-axelns riktning spanna upp ett plan kan man i 
detta plan berakna en hojdprofiltabell i jordfasta koordinater varvid denna tabell tillsammans 
med en modell av lastskopan 142 kan anvandas for att berakna lampliga rorelser med fordon 1 
och lastskopa under lastningsforloppet. 

fs = (cosv|/c, sinv|/c, 0) (27a) 

\ 

lZ = (0,0,1) (27b) 

Vidare infors att hojdprofiien i riktningarna s och Z definieras i variablerna Sg respektive Ziastn 
med origo i X-och Y-led motsvarande angreppspunktens 7222 koordinater Xiastn, Yiasm och i Z- 
led Z(l ,n)=0 enligt DTM. 

En sadan hojdprofil 7577 kan, se figur 14, approximeras ur DTM 821, vamr hojdprofiltabell 
9822 Ziastn = Ziastn(Sg) utgor uppskattad medelhojd av materialvolymen 757 i en mangd av ele- 
ment {nij, j= 1,2,3,... jmax} utmed och inom ett givet avst&nd frSn en tankt linje langs lastsko- 
pans 142 framkant for ett varde Sg = i-d, dar d ar ett lampligt samplingsavst&nd mellan konse- 
kutiva varden pi Sg: 

jmax 

Zmed(Sg)=S Z(l,ilij)/jmax; i = S g /d (28) 
j=l 

Ur ovanstaende varden kan sedan en kontinuerlig kurva Ziastn = Ziastn(s g ) erhallas enligt minsta 
kvadratmetoden genom en styckvis linjar approximation eller genom ett approximerande poly- 
nom. 

Berakning av lastskopans 142 rorelse i ett jordfast koordinatsystem 41 

Vid en lastningsrorelse fors lastskopan 142 in i materialvolymen 757, lyfts upp och roteras med 
hjalp av fordonets 1 rorelse i sin bana i ett jordfast koordinatsystem 41 och med hj&lp av de 
rdrelser i ett fordonsfast koordinatsystem 42, som utfors av lasthanteringsdonets 14 mekanik 
141, dvs vasentligen dess vanligen hydrauliska lyft- och tiltcylindrar, de armar och leder som 
ingar i mekaniken och som satts i rorelse av hydraulcylindrarna, samt lastskopan 142 som ar 
fast i ett av elementen i mekaniken. Figur 12 visar i genomskarning lasthanteringsdonets me- 
kanik 141 och lastskopan 142 samt framre delar (ett hjul och del av chassi) av ett lastfordon. 
Under sin rorelse skar lastskopan ut en mangd material ur materialvolymen. Eventuellt fore- 
kommer ocksa ett visst spill till fbljd av att lastskopan inte rymmer delar av den utskurna mate- 
rialvolymen. Vid ing&ng med lastskopan i materialvolymen ar det oftast lampligt att borja sa 
lagt som mojligt for att sakerstalla att materialet inte blir kvar pa en yta som fordonet sedan ska 
befara. Samtidigt bor man styra hydraultrycket till lasthanteringsdonets lyftcylinder for att under 
intrangningen i materialvolymen latta lastskopan, framst for att reducera lastskopans friktion 
mot marken och darmed fbrhindra onodigt slitage pa lastskopan och sliming pa drivhjulen. 

Genom att fore lastningen, utg^ende fran i DTM-datorn 82 beraknade koefficienter 9821 for 
markplanet vid lastningspunkten och hojdprofiltabell 9822 avseende materialvolymen 757, be- 
rakna lastad mangd material som funktion av intrangningen i materialet, kan man ocksa med 
anvandning av kannedomen om fordonets och lasthanteringsdonets mekanik och dvriga egen- 



skaper berakna onskvart hydraultryck till lyftcylindern som funktion av intrangningen i materi- 
alvolymen si att ovannamnda slitage av lastskopan 142 minimeras samtidigt som sliming und- 
viks. Det gir ocksi att berakna hur mycket lastskopan rymmer som funktion av lyft- och tipp- 
cylindrarnas utslag. Tiltorelsen mojliggor okning av lastskopans rymmande volym men okar 
samtidigt upplagsreaktionen si lange lastskopan fortfarande fors in i materialvolymen. Tiltro- 
relsen bor darfor i princip inte pab5rjas forran intrangningen av lastskopan horisontellt i mate- 
rialvolymen ar avslutad och kan dSrefter kombineras med att lastskopan lyfts upp ur materialvo- 
lymen. Med ovannamnda parametrar och erfarenhetsmassiga ansatser kan man siledes styra 
fordon 1 och lasthanteringsdon 14 genom hela lastforloppet utgiende frin den inmatta terrang- 
modellen 821. Lyftrdrelsen kan avbrytas nar lastskopans 142 skSrande kant beraknas bryta ige- 
nom materialvolymens yta pi sin vag upp ur volymen. Tiltrorelsen kan avbrytas nar tillracklig 
tilt utfbrts for att sakra lasten i transportlage. 

Genom att berakna, for ett antal tillstand k = k(t) = 0,1,2,... som funktion av lopande tid t, last- 
skopans 142 position uttryckt i koordinaterna [x(t), y(t), z(t)] i ett jordfast koordinatsystem 41 
for ett antal punkter i lastskopans geometri, skapas mojlighet att kvantitativt uppskatta sival 
utskuren och lastad volym som storlek och riktning pa de tyngder och reaktionskrafter som last- 
skopan forvantas komma att bli utsatt for under varje sadant steg av lastningsfbrloppet och dar- 
av aven berakna erforderliga itgarder vad galler styrning av cylinderutslag och hydraultryck 
under forloppet for att fbrhindra slitage av lastskopan och slirning pa drivhjulen. Dessutom kan 
rorelsen planeras sa att lastskopans rorelse medfbr att den fylls vid minimalt spill. 

Berakningen bygger pi cylindrarnas utslag som funktion av tiden och deras inverkan pi lasthan- 
teringsdonets 14 mekanik 141 med hjalp av en matematisk modell i analytisk geometri. Berak- 
ningarna sker i ett fordonsfast koordinatsystem 42 varefter erhallna koordinater (£, t|, Q trans- 
former till ett jordfast koordinatsystem 41. Styrvinkeln kan antas vara noil och koordinaten t| 
for varje punkt i lasthanteringsdonet siledes konstant under hela lastningsforloppet, varvid la- 
gesuppgiften som erhills frin fordonets 1 positionsbestamningssystem 7 nar fordonet just ska 
paborja lastningsrorelsen anvands for att gora en prediktering, i det jordfasta koordinatsystemet 
41, av det fordonsfasta koordinatsystemets 42 position i sex frihetsgrader for varje tillstand k(t) 
= 0,l,2,...i lastningsbanan 1223, Utgiende frin denna prediktering transformeras sedan for varje 
tillstand k(t) = 0,l,2,...enligt ovan samtliga koordinater i lasthanteringsdonets mekanik 141 till 
koordinater i det jordfasta koordinatsystemet. 

Lasthanteringsdonets mekanik 141 utgors av ett antal sammanlankade rigida element varav ett 
utgors av lastskopan 142 och dar varje hydraulcylinder kan delas upp i ett par rigida och i for- 
hallande till varandra linjart rdrliga element. For berakning av cylindrarnas inverkan pi lastsko- 
pans lage samt momentant effektbehov under en lastningsbana 1223 eller lossningsrorelse 1233 
kan vid styrvinkel noli denna mekanik med god noggrannhet representeras av en struktur i tva 
dimensioned ^ (framit) och ^ (uppit), i det fordonsfasta koordinatsystemet 42. De rigida ele- 
menten, bestiende av plana armar och stanger och lastskopan representerad av en knutpunkts- 
polygon i ett plan, ar sammanlankade med ett antal axlar vinkelrata mot ^-planet och kan dar- 
for representeras av axel- och tyngdpunkter i detta plan. Varje sidan punkt ar tillordnad ett 
unikt nummer i en global, dvs for hela lasthanteringsdonet gallande numrering frin i = 1 till i = 
imax. Se forenklad modell, Figur 13. 

Den ffcrenklade modellen av lasthanteringsdonets mekanik 141 kan anvandas for att be- 
skriva hur positonen for ett antal punkter avsedda att defmiera lastskopans 142 lage i 
rummet kan beraknas som funktion av cylinderutslagen i lyft- och tiltcylindrarna. Till 
varje element j e {El, E2, E4} hor siledes ett antal punkter som till foljd av elemen- 



tets rigiditet oberoende av lasthanteringsdonets stallning har konstant avstand till ovriga 
punkter inom samma element. Lokalt inom mangden av punkter som ingSr i det rigida 
elementet j numreras punkterna m - 0,l,2,...,mmax(j), dar m = 0 avser tyngdpunkten och 
mmax(j) ar totala antalet axlar som ingar i det rigida elementet j. 

For varje punkt i det fordonsfasta koordinatsystemet betecknas foljande koordinater i planet 
f!;G> m > k) = J| -koordinat gallande tillstand k for 

I punkt nr m inom det rigida elementet nr j (29a) 

I CO,™, k) = ^ -koordinat gallande tillstand k for 

I punkt nr m inom det rigida elementet nr j (29b) 

Vart och ett av de rigida elementen El, E2, E8 maste, for att elementets lage och orientering 
ska kunna definieras, ha minst en axel och en ovrig punkt. For varje element definieras darfor 
en pivotaxel och en indexpunkt med foljande ordningsnummer inom elementet: 

Pivotaxel, ordningsnummer m = 1 
Indexpunkt, ordningsnummer m = 2 



Nedanst&ende tabell visar ett val av pivotaxel, index- och ovriga punkter i den forenklade mo- 
dellen av lasthanteringsdonets mekanik 141. 
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I den tvadimensionella modellen av lasthanteringsdonets mekanik 141 kan pivot- och indexax- 
larnas koordinater beraknas med klassiska plangeometriska formler som funktion av lyft och 
tiltcylindrarnas utslag: 



Koordinatema for de punkter i det rigida elementet E4 som definierar lastskopan 142 kan be- 
stammas pa samma satt som ovriga axlar i rigida element. Genom att representera lastskopan 
med punkter pa dess insida , sS kan dessa punkters koordinater anvandas for att berakna hur stor 
volym lastskopan rymmer i ett visst tillstand liksom hur stor tyngd lasten kan forvantas ha. 
Lastskopans punkter numreras inom det rigida elementet E4 i exemplet som 

ms = 1, 2,..., msmax (30) 

Skoppunkternas koordinater i det fordonsfasta koordinatsystemet 42, tillstand k, £(4, ms, k) resp 
£(4, ms, k) for ms = 1, 2,..., msmax, kan aven beraknas med samma typ av metoder. Nar pa detta 
satt lastskopans 142 geometri ar defmierad i fordonsfasta koordinater kan dessa raknas om till 
koordinater i ett jordfast koordinat system 41. 

Det forutsatts att uppskattning av positionen i det jordfasta koordinatsystemet 41 for det for- 
donsfasta koordinatsystemet 42 i koordinater X = (X, Y, Z) samt kurs- (vy), tipp- (9) och roll- 
vinkel (q>) kan erhSUas fr&n fordonets 1 positionsbestamningssystem 7. 



P& samma satt som ovan visats i ekv (3) for laserinm&tta punkter (£, r|, Q kan aven koordinater 
(£» T]* O i det fordonsfasta koordinatsystemet 42 for element i lasthanteringsdonets mekanik 141 
omvandlas till koordinater x = (x, y, z) i det jordfasta koordinatsystemet 41 med hjalp av trans- 
formationsmatrisen MQV, <p), (2), och positionen X = (X, Y, Z) av det fordonsfasta koordinat- 
systemet i det jordfasta koordinatsystemet: 

x = X + (^ n ,Q*MCF,3,cp) (31) 

Specifikt vid planering av dynamisk lastningsbana 1223 och lossningsrorelse 1233 fbrutsatts att 
fordonet 1 enligt (23a), (23b) och (25) befinner sig i en omgivning av lastningspunkten 1221 pa 
en plan yta i en position X(s) = [(X(s), Y(s) 5 Z(s)] dar s=0 vid lossning och vid lastning pk en 
bana vid kord stracka s i lastningsbanans riktning vj/cfran lastningspunkten 1221 samt att fordo- 
nets kurs-, tipp- och rollvinklar ar vj/c, &c respektive 9c enligt (26a) och (26b). 

Vi har nu sMedes en modell fSr hur fordonet 1 ror sig och kan sedan kombinera denna modell 
med koordinaterna i det fordonsfasta koordinatsystemet 42 for de punkter ms = 1, 2,..., msmax i 
det rigida elementet E4 som representerar lastskopan 142, for att med koordinattransformatio- 
nen enligt (31) erh&lla koordinaterna for sistnamnda punkter i det jordfasta koordinatsystemet 
41: 

X(4, ms, k) = X(s) +£(4, ms, k), r,(4, ms, k), ^(4, m s , k)]* 

* M(ij/c, Sc, cpc) (32) 

dar X(4, ms, k) = [x(4, ms, k), y(4, m s , k), z(4, ms, k)] for ms = mi, m2,..., msmax saledes utgor 
koordinaterna for lastskopans 142 punkt nr ms i det jordfasta koordinatsystemet. En forenklande 
approximation ar att lagga alia de punkter som representerar lastskopan i iJC, - planet i det for- 
donsfasta koordinatsystemet, varvid r|(4, ms, k) kan sattas till noil i (32) ovan. 

Berdkning av den lastade volym, som en planerad rorelse av fordon 1 och lasthanteringsdon 14 
forvdntas ge 

Berakningen bygger pa en hqjdprofiltabell 9822 som enligt ovan beraknats utgaende fran den 
med den scannande laseravstandsmataren 81 uppmatta DTM 821 avseende material volymens 
181 yta samt pa en berakning av den materialmangd som forvantas skaras ut och stromma in i 
lastskopan 142 vid dess rorelse genom volymen. I ett visst tillstand k av lastningsrorelsen be- 
finner sig lastskopan 142 pa vag igenom materialvol)mien. En viss volym av det lastade mate- 
rialet har da skurits ut av lastskopans framkant och strommat in i skopan. Den utskurna och 
instrommade volymen beror av skopans rorelse och form och av materialvolymens form och 
egenskaperna hos dess materialinnehall. Under forutsattning att det lastade materialet ar ett n&- 
gorlunda lattrinnande fast amne, sasom sand, grus och tillrackligt sonderdelad sten och andra 
material kan den utskurna och instrommade volymen uppskattas med tillracklig noggrannhet 
under varje steg av lastningsforloppet for att ligga till grund for en effektiv automatisering av 
lastningsrorelsen. 

Vi betecknar den mellan tillstand k och k+1 utskurna volymen som AVs(k+l). Under forutsatt- 
ning att skopan inte skar alltfor djupt i materialvolymen 181 kan en i ett lodratt plan genom den 
planerade banan for mittpunkten pa lastskopans 142 framkant befintlig tvarsnittsyta av denna 
volym approximeras med en parallelltrapets: "abed" i figur 15, bildad av lodlinjen genom last- 
skopans 142 punkt m g i tillstand k resp tillstand k+1 uppat begransat av hqjdprofilen Ziastn(k) = 
Ziastn[Sg(k)], och ned^t begransad av en polygonkurva med horn i skopspetsens position i s- och 



z-led [Sg(k), z(4, m g , k)], fdr varje k=0,l,2,... Under exempelvis fdrutsattningen att lastskopan 
142 har samma tvarsnitt Over hela sin bredd B galler foljande uttryck for AVs(k+l): 



varvid 



AV s (k+l) = V 2 Bh [Z ]as tn(k) + Ziastn(k+1) - z(4, mg, k) - z(4, m g , k+1)] (33) 



h = Sg(k+l)-s g (k) 



(34) 



dar s 6 (k) = V[x(4, m g , k) - Xiasm] 2 + [y(4, m g , k) - Yiastn] 2 



(35) 



Totala utskurna volymen Vs(k) tecknas 



f 



r=k 

Vs(k) =ZAVs(r), k=l,2,3,... 



(36a) 



r=l 



V s (0) = 0 



(36b) 



Lastskopan 142 rymmer olika volym i olika lagen, se figur 16. En effektiv lastningsrorelse bor- 
jar med att skopans plana nedre skiva i horisontellt lage kors in i material volymen 181 pa en lag 
h6jd nagot over markniva fdr att undvika friktion mot underlaget. Man maste da tillse att det 
finns ett tryck i lyftcylindrarna for att balansera egenvikten av lasthanteringsdon med lastskopa. 
Efterhand som derma intrangning fortsatter fylls skopan med material. Darvid finns risk f5r att 
upplagsreaktionen pa lastskopan okar vilket bor undvikas. Genom att mata trycket i lyftcylind- 
rarnas hydraulmatning och jamfora detta varde med ett planerat varde som ar korrigerat for den 
forvantade tyngden av det lastade materialet i lastskopan kan man styra lastskopans hydraul- 
matningen till lyftrorelsen sa att intrangningen underlattas. Normalt kan p& detta satt intrang- 
ningen fortsatta tills den utskurna volymen motsvarar lastskopans rymd, varvid fordonets gang i 
lastningsbanan 1223 avbryts och lastskopan hojs samtidigt som den tiltas for att astadkomma 
maximal rymd. Hojningen fortsatter darefter tills lastskopan ar fri fran den liggande materialvo- 
lymen varefter utkorningen pSborjas i den dynamiska transportbanan 124 ut ur materialvoly- 
men. I vissa fall kan fbrhallandena vid intrangningen vara sadana att hojningen av lastskopan 
for att reducera upplagsreaktionen medfor att den lastade volymen blir mindre an avsett. Samma 
blir resultatet om maskinen trots Stgarden att hoja trycket i lyftcylindern borjar slira under in- 
trangningen till foljd av att motst&ndet i materialvolymen mot intrangningen blir for stort varvid 
intrangningen maste avbrytas innan avsedd volym erh&llits. Det ar dk mqjligt att ta hansyn till 
detta vid kommande lastningscykler genom att i det fdrsta fallet rakna med lagre densitet for 
materialet och i det andra fallet rakna med att mer energi astadkommen genom hogre varvtal 
eller hastighet krSvs for att tranga in i materialvolymen. 

Berakning av erforderliga lvftkrafter och effektbehov under en lastningsrorelse 

Berakningen bygger pi att, i ett jordfast koordinatsystem 41, tyngd och tyngdpunkt med erfor- 
derlig noggrannhet Sr kand eller kan beraknas for de element och massor som lyfts upp vid 
lastningsrorelsen, samt att fordonet 1 ror sig med konstant hastighet p§ en plan men inte nod- 
vandigtvis horisontell yta enligt (22). Lastningsrdrelsens dynamiska forlopp medfor darvid un- 
der varje tidsintervall ett arbete som ar minst lika med summan av det arbete som erfordras for 
att lyfta upp var och en av dessa massor. Genom att stalla upp ett uttryck for den potentiella 



energin for var och en av dessa massor som funktion av tillstandsvariabeln k kan darur erfor- 
derliga lyftkrafter och effektbehov under en lastningsrorelse beraknas. 

Berdkning av den potentiella energin under en planer ad rorelse av for don 1 och lasthante- 
ringsdon 14. 

Till foljd av symmetrin kring det fordonsfasta koordinatsystemets och ^-riktningar kan, lik- 
som vid berakningen av mekanikens tillst&nd och lastad volym, modellen i tva dimensioner av 
lasthanteringsdon 14 och lastskopa 142 samt konceptet for berakning av volymer anvandas. 
Effektberakningen bygger pa analys av den potentiella energin i de massor som satts i rSrelse 
vid lastningen. Den potentiella energin i tillstand k for de mekaniska elementen i lasthante- 
ringsdon 14 med lastskopa 142 betecknas Umck(k) och for den lastade volymen anvands be- 
teckningen Us(k). Den totala potentiella energin i tillstand k betecknas U(k): 

U(k) = Umek(k) + Us(k) (37) 

Eftersom lasthanteringsdonet 14 under lastningen styrs av ett programmerat tidsforlopp, styrs 
mekanismen sk att tillstand k ska uppnas vid ett visst tidsogonblick, varfor tillst&nd k kan skri- 
vas k(tk), k = 0,1,2,3,... . Tiden melian tw& pk varandra foljande tillstand k och k+1 betecknas 
TSAMP och forutsatts vara konstant dvs tk+i - tk= TSAMP oberoende av k. Energibehovet for 
att bringa systemet fran tillstand k till tillstand k+1 betecknas AU(k) och ar saledes 

AU(k) = U(k+l)-U(k) (38) 

En lastningsrorelse erfordrar normalt nSgot tiotal sekunder medan TSAMP bor vara av stor- 
leksordningen 0.1 s eller kortare for att inte medfora onodiga fordrojningar i styrningen av last- 
hanteringsdonet 14. Med hansyn till de ovriga fel som medfors av ofrankomliga approximatio- 
ner till exempel i modelleringen av materialvolymen kan effektbehovet antas vara konstant un- 
der det s&ledes i forhallande till fbrloppets dynamik korta tidsintervallet (tk, tk+i). En uppskatt- 
ning P(k) av medeleflfekten under detta tidsintervallet kan darfbr tecknas: 

P(k) = AU(k) /TSAMP (39) 

(39) kan anvandas for att vid val av lyft- och tilthastighet minimera tiden fc3r lastningsrorelsen 
och darvid kunna tillse att maximalt tillganglig effekt for manovrering av lasthanteringsdonet ej 
overskrids. 

Berdkning av Umekflc) 

Vi anvander beteckningen M(j) for massan av det rigida elementet Ej. Med tidigare anvanda 
beteckningar kan vi da teckna den potentiella energin Umck(k) i ett jordfast koordinatsystem 41 
for lasthanteringsdonets 14 mekanik 141 och lastskopa 142: 

jmax 

Umek(k) = EgM(j)[z(j, 0, k)- z(j, 0, 0)] (40) 
dar g ar den vertikala tyngdaccelerationen 



Berakning av Us(k) 

En med hansyn till ovriga osakerheter rimlig ansats vad galler tyngdpunkten for den lastade 
volymen ar att satta den till samma som lastskopans tyngdpunkt For lastens potentiella energi i 
ett jordfast koordinatsystem 41 blir da uttrycket: 

Us(k) = p-g [z(4 5 0, k) - z(4, 0 5 0)] Vs(k) (4 1 ) 

DSr p ett matt pa det lastade materialets densitet, i kg/m 3 

Berakning av lastskopans upplagsreaktion 

Nar lastskopan 142 belastar underlaget och samtidigt skall foras framat i en lastningsrorelse 
uppstar en mot denna rorelse riktad rorelsehindrande friktionskraft som beror pa den reaktions- 
kraft eller upplagsreaktion, som Mn underlaget verkar pa lastskopan. Genom att berakna upp- 
lagsreaktionens styrka F(k) som funktion av fordonets 1 och lasthanteringsdonets 14 rorelsetill- 
st&nd k och att darvid aven beakta inverkan av tyngden av lastad volym Ms ar det mojligt att 
styra trycket i lasthanteringsdonets lyftcylinder sa att upplagsreaktionen och darmed den rorel- 
sehindrande friktionskraften minimeras for att darvid underlatta lastningsrorelsen. 

Berakningen bygger pa att i en ekvation pS tva satt teckna det arbete, som erfordras for att i ett 
jordfast koordinatsystem 41 utfdra en infinitesimal hojning h av lastskopan 142. Denna rorelse 
kan ses som resultatet av den infmitesimala langdokning av lyftcylindern som erfordras for att 
lyfta lastskopan hojden h och som i det jordfasta koordinatsystemet medfbr forandringen 
Az(j,0,k) + Oj(h) i z-koordinaten for tyngdpunkten for ett enskilt element j i lasthanteringsdonet 
14. 

Upplagsreaktionen i ett tillstand ko da lyftcylindern ej ar trycksatt och skopans 142 last Ms(ko) = 
0 antas vara F(ko). Ett satt att teckna arbetet blir da F(ko) h. Samma arbete utgors ocksa av fc3r- 
andringen vid denna rorelse av den potentiella energin i ett jordfast koordinatsystem 41 av last- 
hanteringsdonet 14 alia delar enligt ekvation (40). Da galler med anvandning av ekvation (40) 
for en infinitesimal hojning h av skopan frin z-koordinat z(4, 0, ko) i tillstand ko till vardet z(4, 
0,ko)+h. 

jmax 

F(ko) h = Z[gM(j)Az(j,0, ko)+ 0j (h)] (42) 

och saledes kan man berakna F(ko) ur geometrins derivator med avseende pa lastskopans 142 z- 
koordinat [dzG, 0, ko)/dz(4, 0, ko)]; j = 1 jmax: 

jmax 

F(k 0 ) = Z g M(j) [dzC, 0, ko)/dz(4, 0, ko)] (43) 
j=l 

Upplagsreaktionen i ett tillstand k dar lastskopan tagit lasten M s (k) blir under samma forutsatt- 
ningar enkelt: 



F(k) = F(ko) + Ms(k)g 



(44) 



Berakning av erforderlig kraft i lyftcylindern for att balansera lasthanteringsdonet 14 
For att i tillst&nd k enligt ovan balansera lasthanteringsdonet med lasten Ms(k) s& att upplagsre- 
aktionen blir noil antas krava kraften Fi(k) i lyftcylindern. Dk galler for en infinitesimal lang- 
dokning Al av lyftcylindern och en infinitesimal motsvarande hojning h av lastskopan 142 

Fi(k)Al = F(k)h (45) 

och saledes kan man berakna Fi(k) med hjalp av en geometriderivata: 

Fi(k) = F(k)[dz(4,0,k)/dl] (46) 

Under ett lastningsforlopp har visats en metod for att ur den hojdprofiltabell 9822 som erhallits 
ur DTM 821 uppskatta volymen Vs(k) av det material som i tillstand k lagrats i lastskopan 142. 
Om vi som tidigare antar att densiteten for materialet ar p s§i kan den lastade massan med an- 
vandning av (36) tecknas som en funktion Ms(k) av tillstand k: 

Ms(k) = pV s (k) (47) 

varefter ett uttryck pa ett lampligt maxvarde for den kraft som ska ansattas i lyftcylindern vid 
tillstand k for att balansera lasthanteringsdonet 14 med forvantad last enligt (47) ar 

[Fl(k)]max = [F(ko) + p gVs(k)] {dz[4, 0, k]/dl} (48) 

eller med 0<p<l dar vardet pa p valjs genom praktiska forsok 

Fl(k) = (3[Fi(k)]max (49) 

Genom att i styrtabellen 971 fdra in lyftcylinderkraften enligt (49) mqjliggor man att maximal 
framdrivningskraft kan erhallas av fordonets 1 drivhjul under den viktiga del av lastningsmo- 
mentet di lastskopan 142 fors in till sitt maximala djup i materialvolymen 18L 

Hinderdetektering 

Ett system for hinderdetektering bor innehalla dels sensorer som mater in och lagrar informa- 
tion avseende forekommande hinder, dels beslutskriterier baserade pa denna information samt 
kannedom om fordonets 1 saval befintliga position som dess planerade bana for att faststalla om 
banan kan anses fri fran hinder eller ej. 

Hinderdetektering avser att upptacka och i tid larma for saval stillast£ende som rorliga hinder 
182 som kan komma i fysisk kontakt med fordonet 1 vid dess planerade eller fortsatta rorelse. 
Med hinder avses framst foremal av en viss minsta storlek inom hinderfri zon 191 enligt DTM 
821, men aven objekt utanfbr hinderfri zon kan utgora hinder och det ingar i hinderdetektering- 
ens uppgift att aven upptacka och i tid larma for sadana objekt i fordonets vag. Det ar ocksa 
hinderdetekteringens uppgift att kontrollera s& att fordonet inte kommer utanfbr hinderfria zoner 
eller lastnings- och lossningszoner. 

Fordonet 1 kan ur hinderskyddssynpunkt tillordnas olika hinderskyddszoner med for minskande 
avst^nd till fordonet okande grad av beaktande av forekomst av eventuellt hinder, s&som Stgar- 
der pa en skala fr&n varningssignal, darefter sankt hastighet till nodstopp i inre zon eller zoner. 
Varje s&dan hinderskyddsgeometri 195 kan laggas in som en tabell i DTM-datorn 82 och an- 
vandas tillsammans med fr^n uppdragsdatorn 6 erhallen styrtabell 971 for att utvardera kriterier 



baserade pa data i DTM 821 for atgard vid forekommande hinder inom hinderskyddszon vid 
s&vMl fordonets befintliga position som dess planerade bana enligt styrtabellen. 

Vid autonom navigering mottar tede fordonsstyrdatorn 211 och DTM-datorn 82 vid starten av 
varje bansegment en styrtabell 971 avseende statiskt 11 eller dynamiskt 12 bansegment. DTM- 
datorn kan utgaende fran denna tabell faststalla vilka element av den dynamiska terrangmodel- 
len som kommer art sammanfalla med fordonets 1 hinderskyddsgeometri 195 under detta ban- 
segment. Se figur 18. Om ett hinder da upptacks inom ett sadant element kan ett larm utlosas, se 
kriterium for hinderdetektering, sid 13. Genom att i hinderskyddsgeometrin anvanda flera olika 
stora skyddszoner kring fordonet ar det mojligt att varna for ett hinder i yttre men utanfor inre 
zoner och signalera nodstopp vid hinder inne i inre zoner. 

L&t />(K, L) vara punkter och X(K, L) = £(K, L), ti(K, L), ^(K,L)] vara motsvarande ortsvekto- 
rer i en koordinattabell i tre dimensioner av det fordonsfasta koordinatsystemet 42 varvid 
punkterna P(K, L) avser fordonets hinderskyddsgeometri 195 och som for var och en av nivaer- 
na L = 1, 2,..., LMAX best&r av en fordonsfast hinderskyddszon JA(L), 1951, begransad av en 
sluten granspunktspolygon co(L) 1952 som utgors av en foljd av rata linjer fran P(K, L) till 
P(K+1, L) for K = 1 KMAX-1 samt den rata linjen fran p(KMAX, L) till p(l, L). 

Lat X(s) = [X(s), Y(s), Z(s)] vara koordinater och \j/(s), 9(s), cp(s) vara kurs-, tipp- och rollvink- 
lar i det jordfasta koordinatsystemet 41 for det fordonsfasta koordinatsystemet 42 i en punkt 
P(s) belagen en stracka s - So utmed fordonsbanan fran fordonets 1 aktuella position med mot- 
svarande koordinater X(so), dar fordonsbanan ar definierad av en styrtabell 971 fran uppdrags- 
datorn 6. En hinderskyddsavbildning 1954 p& hinderskyddsniva L av den fordonsfasta hin- 
derskyddszonen JA(L) pa referensytan 17 i det jordfasta koordinatsystemet utgors da av den zon 
A(L, s) som ligger inom en sluten granspunktspolygon n(L,s), 1953, som bildas av de punkter 
P(K, L 9 s), vardera med ortsvektorn X(K, L, s) = [X(K, L, s), Y(K, L, s), Z(K S L, s)], 
K=1,2,...,KMAX och dar varje sadan punkt P(K, L, s) ar en avbildning pa referensytan i det 
jordfasta koordinatsystemet 41 av punkten p(K, L) med ortsvektorn X(K, L) = [£(K, L), ti(K, 
L), <;(K,L)] tillhorig granspunktspolygonen co(L) i det fordonsfasta koordinatsystemet 42. Slut- 
ligen bildas en jordfast hinderskyddszon 1955 som foreningsmangden 0(L,s) av samtliga zoner 
A(L, u), so < u < s. 

Foljande samband galler darvid: 

1° kurvan Q(L,s) utgors av en foljd av rata linjer fran P(K, L, s) till P(K+1, L, s) for K = 1,..., 
KMAX-1 samt den rata linjen fran P(KMAX, L 5 s) till P(l , L, s) och 

2° Avbildningen P(K, L, s) av punkten P(K 9 L) i det fordonsfasta koordinatsystemet 42 pa refe- 
rensytan 17 har X- och Y-koordinaterna X(s) och Y(s), dar X(s), Y(s) och vj/(s) ar, i jordfasta 
koordinatsystemets 41 koordinater, position i horisontalplanet respektive kursvinkel for det 
fordonsfasta koordinatsystemet 42 enligt styrtabell 971, varvid galler: 

X(K, L, s) = X(s) -f X(K, L)*M[vi/(s) 3 9(s) 9 <p(s)] (50) 

dar tan[£(s)] = - Xn(s) cos[\ I ;(s)] - Yn(s) sin[H/(s)] (5 1 a) 



och 



tan[<p(s)] = Xn(s) sin[v|/(s)] + Yn(s) cos[\|/(s)] 



(51b) 



3° Avbildningen P(K L, s) av punkten />(K, L) i det fordonsfasta koordinatsystemet 42 pa refe- 

;X Tf m c [C(s) • X(s) Xn(s) • Y(s) Yn(s)]/ Zn ^ dar ko ^™»- 

terna Xn(s) Yn(s) och Zn (s) samt konstanten C(s) fdr en till DTM 821 i punkten X(s) med 
mmste kvadratmetoden anpassad plan tangentyta med ekvationen XXn(s) + YYn(s) + ZZn(s) 
= C(s) kan berSknas med hjalp av DTM 821 for en mangd punkter pa referensytan i en om- 
givmng av punkten med koordinaterna [X(s), Y(s)] i horisontalplanet. 

4 ° W ndersk y ddsavbi ldningen 1953 pa referensytan 17 av JZI(L), den fordonsfasta hin- 

derskyddszonen 1952 pa niva L, utg5rs av ytan inom kurvan fl(L,s). 

5° En jordfast hinderskyddszon 1955 utgdrs av fdreningsmangden 0(L,s): 
u = s 

©(L,s) = U A(L,u) (52) 

U = So 

DTM-datorns 82 uppgift ar att for varje ny positionsuppgift fran positionsbestamningssystemet 
samt vid mottagen ny styrtabell 971 granska denna genom att undersoka DTM 821 inom omra- 

den 0(L,s), L-1,...,LMAX, och vidtaga de atgarder som utvarderingen av nedanstaende kriterier 
impJicerar: 

1° Om Z(4, n)= 1 och givet trOskelvarde H < Z(l, n) - Z(2, n) for nagot element n inom 
0(L so), n - 1 ,2,...,nmax, sa finns i minst en punkt av den jordfasta hindersskyddszonen 
1955 nummer L ett hinder som ffcranleder hinderskyddsatgard med meddelandenummer H(0, 

2° OmZ(4, n) = 0 for nagot element n inom 0(L,s o ), n = l,2 3 ...,nmax, sa ligger minst en punkt 
ay den jordfasta lundersskyddszonen 1955 nummer L redan utanfdr hinderfritt omrade och 
foranleder hinderskyddsatgard med meddelandenummer H(0, L). 

3° OmZ(4,n)= 1 och givet trSskelvarde H < Z(l, n) - Z(2, n) for nagot element n inom 0(L,s), 
n - 1,2 nmax, sa finns 1 minst en punkt av fordonets hinderskyddsgeometri 195 nummer L 
enhgt den planerade banan ett hinder som fdranleder hinderskyddsatgard nummer H(l L) 

40 0m / (4 ' n l = 0 f ° r n ?g ot element n ™™ ®(L.s), n = l,2,...,nmax, sa ligger minst en punkt 
av den jordfasta hmdersskyddszonen 1955 nummer L enligt den planerade banan utanfdr 
hinderfritt omrade och fdranleder hinderskyddsatgard nummer H(l, L) 

? n J le ^ d f SmeddeIanden *** D ™- datom vid en inre hinderskyddsgeometri J=l och en yttre 
hinderskyddsgeometri J=2: 7 

H(0, 1): Nodstoppsmeddelande 9841 direkt till fordonsstyrdatorn 211 

H(0, 2): Varningsmeddelande 9842 till fordonsstyrdatorn 211 med mdjlighet att sanka hastighe- 
ten.. *^ 

H(l, 1): Forkastande av planerad bana i granskningsmeddelande 980 till uppdragsdatorn 6 
H(l, 2): Varningsmeddelande 9842 till fordonsstyrdatorn 211 med mdjlighet att sanka hastighe- 



5. Patentkrav f 

1 ) Ett forfarande for att utgaende fran matningar med fordonsbuyha sensorer ombord pa ett ror- 
ligt fordon bygga upp och underhalla en dynamisk terrangmodell inom ett avgransat arbetsom- 
rade och i ett jordfast koordinatsystem och dar detta fbrfarande/ar kannetecknat darav 
att denna dynamiska terrangmodell utgors av i ett rutnat eller pa annat satt entydigt ordnade 
element n = 1,2,3,... som representeras av koordinatpunkter [X(n),Y(n)] i horisontalplanet, med 
for varje sadant element n i modellen tillhdrande varden Z(n) och dar X(n), Y(n) och Z(n) utgor 
koordinater i ett jordfast koordinatsystem och dar Z(n) utgor ett medelvarde eller pa annat satt 
uppmatt eller beraknat representativt varde av Z-koordinaten for punkter inom ett begransat 
avstand i horisontalled fran koordinatpunkt [X(n),Y(n)] pa ytan av till exempel mark, material- 
volymer och andra hanteringsobjekt samt pa fdrekommahde hinder, att en fordonsburen scan- 
nande sensor mater avstand i olika riktningar i ett fordonsfast koordinatsystem till sadana 
punkter och att, baserat pa givna noggrannhetskrav, ett 'godtagbart antal sadana matningar fbrut- 
satts ligga till grand for den uppskattning Z(n) som laggs in i modellen, att det fordonsfasta ko- 
ordinatssystemets lage och orientering i ett jordfast koordinatsystem mats in med ett positions- 
bestamningssystem enligt svenskt patent nr 464 83? for bestamning, i ett jordfast koordinatsys- 
tem, av ett fordonsfast koordinatsystems position i ire dimensioner samt dess kurs-, tipp- och 
rollvinklar utgaende fran vinkelmatningar i ett fordonsfast koordinatsysem mot ett antal mark- 
fasta reflektorer inom ett avgransat arbetsomrade/och att den dynamiska terrangmodellens ko- 
ordinater i det jordfasta koordinatsystemet for punkter pa ytan av olika objekt inom arbetsomra- 
det beraknas med en koordinatransformation av/den fordonsburna scannande sensoms avstands- 
och vinkelbestamningar i det fordonsfasta kooyiiinatsystemet. 

2) Ett rorfarande enligt patentkrav 1 ) ovan kannetecknat d 3 r a v att for varje element n 

i modellen kan finnas flera varden pa hojdangivelsen Z, dar ett sadant varde Z(l ,n) ar baserat pa 
enbart fordonets aktuella matningar av en gjVen maximal alder, ett annat varde Z(2,n) represen- 
terar en referensyta utan hanteringsobjekt, rfraterialvolymer, kanda och okanda hinder, dar ett 
tredje varde Z(3,n) avser referensyta, hanteHngsobjekt, materialvolymer och kanda hinder fbr 
vilka ingaende Z-varden fbr elementen i nlodellen avser matningar fran tidigare korningar inom 
arbetsomradet eller pa annat satt inmatadi grunduppgifter och att darvid varden fran eventuella 
matningar mot tidigare icke kanda men alter upptackten borttagna hinder har rensats bort och 
ersatts med varden som avser samma element utan hinder. 

3) Ett forfarande enligt patentkrav 1) fdr att med ett rdrligt fordon finna en punkt (Xiastn, Yiastn) 
eller (Xiossn, Yiossn) fbr angivelse av begynnelseposition for dess lasthanteringsdon i en tankt 
lastnings- respektive Iossningsrbrelse hied ett hanteringsobjekt eller i en materialvolym och dar 
detta forfarande arkannetecknaftdaravatt fordonet framfors pa en i fcirvag planerad 
spaningsbana mot en inom en polygohkurva i ett jordfast koordinatsystem avgransad lastnings- 
eller lossningszon, att fran en punkt feller linje raknat vid lastning den narmaste eller pa annat 
satt mest lampliga punkten, med koirdinaterna (Xiastn, Yiastn) i det jordfasta koordinatsystemet, 
sbks bland de element av den dynarfiiska terrangmodellen som blivit inmatta med ett godtagbart 
antal matningar under fordonets baAa fran den punkt nar vardet Z(n) fbr ett fbrsta element n i 
den dynamiska terrangmodellen inim avsedd lastningszon blivit bestamt med ett godtagbart 
antal matningar och vid villkor A £ Z(n) dar A ar en given minsta hbjdniva tills fordonet daref- 
ter hunnit fbrflytta sig en given strjkcka langs spaningsbanan, att denna sbkning fdr narmaste 
angreppspunkt fbr fordonets lastskopa eller annat motsvarande redskap fbr lastning med koor- 
dinatema (Xiastn, Yiastn) i det jordfasta koordinatsystemet baseras pa sSdana element n i den dy- 
namiska terrangmodellen fdr vilki gailer B < Z(n), dar B ar en given minsta lastningsvard 
hdjdniva per element och att dennja sdkning inom avsedd lossningszon fbr mest aviagsna eller 
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pi annat satt mest lampliga tomningspunkt for fordo/iets lakskopa eller annat motsvarande red- 
skap vid lossning med koordinaterna (Xiossn, Yiossn) Met jordfasta koordinatsystemet baseras p& 
sadana element n i den dynamiska terrangmodellen for vilka galler Z(n) < C, dar C ar en given 
maximal h(5jd i ett element for att medge lossnin^/i detta element. 

4) Ett forfarande enligt patentkrav 3)kanneticknat daravatti stallet for Z(n) ur den 
dynamiska terrangmodellen enligt patentkrav 1^ anvands ur den dynamiska terrangmodellen 
enligt patentkrav 2) koordinaten Z(l, n) som niatt pk hojdniva i ett element av den dynamiska 
terrangmodellen for berakning av narmaste e|4er pk annat satt mest lampliga angreppspunkt for 
lastskopans ingang i en materialvolym vid lafetning eller mest avlagsna eller pa annat satt mest 
lampliga tomningspunkt for lastskopan vid lossning. 

5) Ett forfarande enligt patentkrav 3) k a rj/n e t e c k n a t d a r a v att i stallet for Z(n) ur den 
dynamiska terrangmodellen enligt patentkrav 1) anvands ur den dynamiska terrangmodellen 
enligt patentkrav 2) mattet Z(l, n) - Z(2,/i) som mitt pk hojdniva i ett element av den dynamis- 
ka terrangmodellen for berakning av narmaste eller pk annat satt mest lampliga angreppspunkt 
for lastskopans ing&ng i en materialvolVm vid lastning eller mest avlagsna eller pk annat satt 
mest lampliga tomningspunkt for lastsjcopan vid lossning. 

6) Ett forfarande for att med hjalp av in dynamisk terrangmodell som byggs upp och underhalls 
med forfarande enligt patentkrav 2) 4ed ett rorligt fordon upptacka tidigare icke kanda hinder 
inom hinderfria zoner av det avgransjkde arbetsomradet kannetecknat darav, att detta 
fordon styrs utefter en kand bana, aty till ett fordon hor en eller flera fordonsfasta hinderskydds- 
zoner, var och en i form av ett inom/en polygonkurva i ett fordonsfast koordinatsystem begansat 
omrade med till varje omrade horanfde hinderskyddsatgard i form av varningssignal, sankt has- 
tighet, nodstopp eller annan avbrott^atgard, att hinderskyddsavbildning ar ett inom en polygon- 
kurva i ett jordfast koordinatsystenji avgransat omrade som utgor projektionen i horisontalplanet 
av en fordonsfast hinderskyddszon i ett lage av fordonet i sin bana, att jordfast hinderskyddszon 
ar ett inom en polygonkurva i ett jordfast koordinatsystem begransat omrade som utgor fore- 
ningsmangden av de hinderskydd$avbildningar fran fordonets positioner i banan som harror 
fran nagon av fordonets hindersk^ddszoner, att hinderfri zon ar en inom en polygonkurva i ett 
jordfast koordinatsystem avgransad zon utanfbr eventuella lastnings- och lossningszoner, att 
fragan om hinderfbrekomst standigt utvarderas i sadana element n av den dynamiska terrang- 
modellen vars koordinatpunkter fX(n),Y(n)] ligger inom hinderfri zon samt inom till varje for- 
donsfast hinderskyddszon horanie jordfasta hinderskyddszon, att en del av provningen bestar i 
att for sadana element n skillnadjbn Z(l, n) - Z(2, n) jamfors med ett givet troskelvarde H och 
om skillnaden overskrider detta iroskelvarde sa larmas ft>r hinder enligt den dtgard som ar av- 
sedd for den av fordonets hindefskyddszoner som anvants for provningen, att en annan del av 
provningen bestir i att utvardera fordonets planerade bana med hjalp av de jordfasta hin- 
derskyddszonerna och darvid uhdersoka om for nagot element n i n&gon jordfast hinderskydds- 
zon dess koordinatpunkt [X(n)/Y(n)] ej ligger i nagon hinderfri zon varefter larm utloses for 
hinder enligt den atgard som M avsedd for den av fordonets hinderskyddszoner som anvants for 
provningen 

7) Ett forfarande for att med Walp av den dynamiska terrangmodellen enligt patentkrav 1) och 
utgaende fran en genom forfarande enligt patentkrav 3), 4) eller 5) beraknad angreppspunkt 
(Xiasm, Yiasm) berakna en hojctorofil, kannetecknat darav, att hdjdprofilen kan skrivas 
som en tabell med samhorigaf varden [s(i),x(i), y(i), Ziasm(i)] for i=l, 2, 3,... langs en given bana 
for fordonets lastskopa eller redskap dar varje s&dant i-varde avser ett fr&n ovannamnda an- 
greppspunkt raknat intrangningsdjup s(i) langs banan samt koordinater x(i), y(i) i det jordfasta 
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Cn PUnkt P& banan fdr detta ^gningsdjup, att till varje sadant i-varde 
nor ett matt Z«astn(i) som avser en yta med given och' konstant bredd tvars den angivna banans 
nktning, att detta Ziastn(i) i hojdprofilen avser de element n av den dynamiska terrangmodellen 
som omger, , nagon punkt sammanfaller med eller ligger i en begransad omgivning av en Iinie 
tvars med och centrerad over banan och att fran Varje sadant element n anvands vardet Z(n) for 
att bilda ett antmetiskt medelvarde, att detta medelvarde utgor vardet Z.a*n(i) avseende gnipp i 
av samhonga varden i hojdprofilen. ' 8»«ppi 

2J? 1 ? r ?T de & \ att mCd hja,p aV d6n d yW^ terrangmodellen enligt patentkrav 2) och 
uttjaende fran en enligt patentkrav 3), 4) eller/5) beraknad angreppspunkt (X^, Yiastn) berakna 
en hqjdprofil, k a n n e t e c k n a t d a r a v. att hojdprofilen kan skrivas som en tabell med 
samhonga varden [s(i), x(i), y(i), Z.as,„(i)] fq r i=l, 2,3 langs en given given bana fdr fordo- 
nets lastskopa eller redskap dar varje sadant i-varde avser ett fran ovannamnda angreppspunkt 
IZf t ! n trangIU "? "® ?°8« banan ^ koordinater x(i), y(i) i det jordfasta koordinatsys- 
temet ill en punkt pa banan for detta intr^hgningsdjup, att till varje sadant i-varde hor ett matt 
ZiastnO) som avser en yta med given och konstant bredd tvars den angivna banans riktning, att 
detta matt Ziastn(i) i hojdprofilen avser de/element n av den dynamiska terrangmodellen som 
omger, i nagon punkt sammanfaller med eller som ligger i en begransad omgivning av en linie 
Wars med och centrerad over banan, att/fran varje sadant element n anvands vardet Z(l ,n) - 
Z(2,n) for att bilda ett aritmetiskt medelvarde, att detta medelvarde utgor vardet ZiaWi) avseen- 
de grupp i av samhoriga varden i hojdprofilen. 

;' 

i 

9 l T ^Z™** f6T , an med hjalp 3V ^ en d y namiska terrangmodellen enligt patentkrav 2) och 
utgaende frto en enligt patentkrav 3)/ 4) eller 5) beraknad angreppspunkt (X, as tn, Y las , n ) berakna 
en hojdprofil, kannetecknat <{arav,att hojdprofilen kan skrivas som en tabell med 
samhonga varden [s(i), x(i), y(i), Zifn(l,i), Z,as ta (2,i)] for i=l, 2, 3,... langs en given bana for 
fordonets lastskopa eller redskap dar varje sadant i-varde avser ett fran ovannamnda angrepp- 
spunkt raknat mtrangningsdjup s(i)/langs banan samt koordinater x(i), y(i) i det jordfasta koor- 
duiatsystemet till en punkt pa banah for detta intrangningsdjup, att till varje sadant i-varde hor 
ett par matt Ziast„(l,i) och Z.astn(2,i^ som avser ytor med given och konstant bredd tvars den 
angivna banans nktning, att dessa/samhoriga varden avseende index i i hojdprofilen avser de 
element n av den dynamiska terrangmodellen som ligger i en begransad omgivning av en linje 

u%?f centrerad 6ver ban * n > att fran varje sadant element sa anvands vardena Z(l n) 
och Z 2,n) for att bilda aritmetisk^ medelvarden Zias,n(l,i) och Z,asm(2,i) avseende grupp i 'av 
samhonga varden i hojdprofilen.! 



10) Ett forfarande for att planerafoch styra en lastmaskin i en lastningsbana samt maskinen och 
dess redskaps rorelse under en lafstningsoperation, k a n n e t e c k n a t d a r a v, att den berak- 
nade hojdprofilen enligt patentkiav 7) eller 8) anvands for att med numerisk integration av en 
iW? n ,Z • - ?V * ^^SPnasdjupet och f(s) ar en kurva som anpassats till punktema 
lsoj,^as ta (i)j i -1,2, 3,... berakha en uppskattning av lastad volym som funktion av intrane- 
nmgsdjupet for att darmed avgota hur langt in i materialvolymen som lastskopan ska fbras fdr 
att fyllas under lastningsrorelseii. 

11) Ett forfarande for att planer^ och styra en lastmaskin i en lastningsbana samt maskinen och 
t£S?^J! , Under Cn ^"gsoP^tion, k a n n e t e c k n a t d a r a v, att den berak- 
nade hbjdprofilen enligt patentkrav 9) anvands fdr att med numerisk integration av en funktion 
™ - 7 n ? m *^ n f .^"N och - m ar en kurva som anpassats till punkterna [s(i), f(i)]; 
f(.) - Z lasta (l, i) - Z.astn(2, ,); . = 1, 2, 3,... berakna en uppskattning av lastad volym som funktion 



av intrangningsdjupet for att darmed avg'ora hur langt in i materialvolymen som lastskopan ska 
f&ras for att fyllas under lastningsrorelsen. 

12) Ett forfarande for att planera och sfyra en lastmaskin i en lastningsbana samt maskinen och 
dess redskaps rfirelse under en lastningsoperation, kannetecknat darav, att den berak- 
nade hojdprofilen enligt patentkrav 7) < 8) eller 9) anvands for att med numerisk integration av 
en funktion Z = f(s) dar s ar intrangniiigsdjupet och f(s) ar en kurva som anpassats till punkterna 
[s(i), Ziastn(i)] respektive [s(i),Ztastn(l, j)]; i = 1, 2, 3, ... berakna en uppskattning av lastad volym 
som funktion av intrangningsdjupet f$r att darmed avgdra hur langt in i materialvolymen som 
lastskopan ska foras for att fyllas under lastningsrorelsen, att denna numeriska integral ocksa 
anvands for att berakna ftirvantad tynjgd av det utskurna materialet i lastskopan for att vid olika 
intrangningsdjup under operationen kunna skapa en mot tyngden av lastskopan och lastad vo- 
lym balanserande kraft pa lastskopan fran lasthanteringsdonets stalldon och genom att darige- 
nom reducera upplagsreaktionen pa ljastskopan fran underlaget underlatta intrangningen i mate- 
rialvolymen vid lastning 



13) Ett fdrfarande for att planera ochj styra en lastmaskin i en lastningsbana samt maskinen och 
dess redskaps rorelse under en lastningsoperation, k a n n e t e c k n a t d a r a v, att den berak- 
nade hojdprofilen enligt patentkrav $) anvands fbr att med numerisk integration av en funktion 
z - f(s) dar s ar intrangningsdjupet o|ch f(s) ar en kurva som anpassats till punkterna [s(i), f(i)]; 
f(i) = Ziastn(l, i) - Ztetn(2, i); i = 1, 2, 3, ... berakna en uppskattning av lastad volym som funk- 
tion av intrangningsdjupet for att darned avgora hur langt in i materialvolymen som lastskopan 
ska foras for att fyllas under lastningferorelsen, att denna numeriska integral ocksa anvands for 
att berakna forvantad tyngd av det utskurna materialet i lastskopan for att vid olika intrang- 
ningsdjup under operationen kunna skapa en mot tyngden av lastshanteringsdon innefattande 
Iastskopa och lastad volym balanserande kraft fran lasthanteringsdonets stalldon och genom att 
darmed reducera upplagsreaktionen pa lastskopan fran underlaget underlatta intrangningen i 
materialvolymen vid lastning. 

j 

14) Ett fbrfarande for att planera hur iitslaget av stalldonen i ett lasthanteringsdons lyftande ro- 
relse ska avbrytas vid lastning ur en irtaterialvolym kannetecknat darav, att lastsko- 
pans position, definierad av ett antal i lastskopans kropp befintliga punkter K(j),T|(j)^0)]. j = 1 . 
2, 3, ... i ett fordonsfast koordinatsyst|m beraknas som funktion av stalldonens utslag, att last- ' 
skopans position [x(j), yO), z(j)] ; j = 1, 2, 3, ... i ett jordfast koordinatsystem beraknas genom 
koordinattransformation av punkterna^ R0).»l0)^(j)l, j = 1.2,3,... varvid transformationen base- 
ras pa positionsbestamning ur fdrfararide enligt svenskt patent nr 464 837 av det fordonsfasta 
koordinatssystemet i ett jordfast koonjinatsystem, att ytan av den materialvolym som lastningen 
avser ar avbildad med en dynamisk tefrangmodell enligt patentkrav 1) eller 2) pa formen [s(i), 
Ziasm®] respektive [s(i),Ziastn(l, i)]; i 4 1, 2, 3, ... , att lyftrorelsen avbryts nar for samtliga de 
punkter som definierar lastskopans form galler Z[x(j), y(j)] < z(j), j = 1,2,3,... dar Z(x,y) ar en 
yta i det jordfasta koordinatsystemet som anpassats till terrangmodellen i punkterna n = 1 2 3 
[X(n),Y(n),Z(n)] respektive [X(n),Y(ii),Z(l,n)],n= 1,2,3 



Arnex Navigation Systems AB ***: V 

Intelligenta funktioner for fordon och automatiska lastmaskiner 
Patentansokan, sammanfattning arb!1223 



Sammanfattning 

Patentansokan avser forfaranden for att utoka fdrarlosa fordons och automatiska lastmaskiners 
autonoma fbrmaga, dels vad galler lastnings- och lossningsmomenten, dels vad galler 
ftrmagan att vid autonom drift med hog sakerhet upptacka hinder i korbanan. Uppfinningen 
loser detta problem genom att bygga upp och underhalla en dynamisk terrangmodell DTM 
mom ett begransat arbetsomrade, utgaende fran matningar med en kombination av en 
scannande laseravstandsmatare och ett fordonsburet positionsbestamningssystem, vilket i i sex 
tnnetegrader bestammer fordonets och den scannande laseravstandsmStarens Iage i ett jordfast 
koordinatsystem. En sarskild DTM-dator anvands for att registrera och analysera ytan av 
terrang, matenalvolymer och hinder framfOr fordonet och dar positionsbestamningssystemet 
fbrutom att ge positionsuppgifter for fordonets banstyrning aven mojliggor att uppdatering av 
ovannamnda terrangmodell och jamforelser mot tillkommande matningar sker i ett jordfast 
koordinatsystem och vartill data fran DTM anvands for att planera fordonets bana, 
lasthantenngsdonets rorelse och fdr att utvardera kriterier for hinderfdrekomst 
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Fig 8: 
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Fig 10: 
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Fig 14: 
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Fig 15: 
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Fig 17: 



Mqter ialvolym 181 
Z(2,m) Mark/referen syta 7 7 




Hinder 182 



• • • 

• 
• 



••• 
• 



Z(l,m) Scannad terrangyta i jordfasta koordinater 




Z(l,m) - Z(2,m) Scannad hojd over kand referensyia 




Fig 18: 




